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1.0.  INTRODUCTION 


This  document  constitutes  the  final  technical  report  for  the  U.S.  Army  Tank- Automotive 
Command  (TACOM)  project  entitled  "Development  of  Driver/Vehicle  Steering  IntCTaction 
Models  for  Dynamic  Analysis"  conducted  by  the  University  of  Michigan  Transportation 
Research  Institute  (UMTRI)  under  contract  DAAE07-85-C-R069.  The  purpose  of  the 
research  conducted  under  this  project  was  to  develop  a  computer-based  steering  control 
model  (or  "driver  model")  of  the  human  operator  for  use  by  TACOM  within  its  large-scale 
vehicle  simulation  program.  The  model  was  to  realistically  represent  steering  control 
behavior  of  actual  drivers  during  path-following  and  obstacle  avoidance  maneuvers. 
Predictions  of  driver  steering  control  behavior  by  the  model  were  to  be  subsequently 
validated  by  comparison  with  direct  measurements  of  diiverArehicle  tests  conducted  dming 
the  latter  course  of  the  project.  The  validation  testing  took  place  at  the  Chrysler  Proving 
Grounds  and  involved  a  number  of  test  maneuvers  including  negotiation  of  obstacle 
courses,  lane-change  maneuvers,  steady  turning  along  circular  paths,  and  braking 
maneuvers.  Data  collected  from  these  tests  were  used  to  correct  any  observed  deficiencies 
in  the  initial  model  and  to  select  parameter  values  for  the  driver  model  for  representing 
realistic  driver  steering  behavior. 

The  basis  of  the  driver  modelling  effort  was  an  UMTRI  steering  control  model  used 
previously  to  represent  steering  control  behavior  of  passenger  car  drivers.  It  was  proposed 
that  the  UMTRI  model  be  modified  and  extended  under  this  project  to  represent  the  steering 
behavior  of  drivers  when  controlling  a  broader  and  more  unusual  class  of  vehicles  of 
interest  to  TACOM. 


2.0.  OBJECTIVE 

The  principal  goal  of  this  work  was  to  develop  a  practical  model  of  driver  steering  control 
which  could  be  used  to  represent  and  predict  realistic  steering  responses  of  human 
operators  dming  path-following  and  obstacle-avoidance  maneuvers.  The  model  was 
intended  to  be  used  with  a  variety  of  different  vehicle  configurations  and  for  a  reasonable 
range  of  vehicle  operating  conditions. 

An  equally  important  objective  was  to  validate  the  developed  model  through  direct 
comparison  with  full-scale  test  data  collected  during  the  project.  The  test  data  would 
involve  selected  vehicles  and  drivers  performing  a  variety  of  path-following  and  obstacle 
avoidance  maneuvers.  The  initial  project  plan  called  for  testing  several  different  vehicle 
types  including  a  steered-wheel  vehicle  (e.g.  the  HMMWV),  an  articulated  vehicle  (e.g.  the 
LVS),  and  a  tracked  vehicle.  However,  because  of  the  unavailability  of  the  latter  two 
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vehicle  types  during  the  proposed  project  testing,  the  HMMWV  and  a  HMMWV-Trailer 
(MlOl)  combination  vehicle  served  as  the  primary  test  vehicles  for  the  model  validation. 


3.0.  CONCLUSIONS 

A  computer-based  model  used  to  steer,  in  a  human-like  manner,  a  wide  variety  of  land 
vehicles  was  successfully  developed  and  demonstrated  under  this  work.  Test  data, 
collected  to  validate  the  driver  model  predictions,  provided  convincing  evidence  of  the 
capabilities  of  the  new  model.  Significant  agreement  between  test  track  measurements  and 
corresponding  model  predictions  was  demonstrated  for  a  variety  of  path  tracking  and 
obstacle  avoidance  maneuvers. 

A  sequence  of  specialized  tests,  conducted  under  unusual  nonlinear  operating  conditions, 
produced  new  experimental  results  clearly  showing  how  drivers  can  stabilize  and  control 
vehicles  operating  beyond  the  conventional  boundaries  used  to  define  the  limits  of  vehicle 
directional  stability.  Investigation  of  this  same  phenomena  during  the  project  with  the 
developed  driver  model  produced  a  nearly  identical  result.  This  finding'  provided  further 
evidence  of  the  capabilities  of  the  new  model  for  predicting  likely  human  operator  steering 
responses  under  unusual  maneuvering  conditions. 

With  respect  to  the  conventional  steering  maneuvers  conducted  under  this  project: 

•  The  test  drivers  used  in  this  test  program  reacted  more  quickly  than  what 
has  been  traditionally  reported  in  the  technical  literature  as  typical  for 
"average"  drivers  of  passenger  cars.  The  conclusion  was  that  such 
differences  in  driver  response  characteristics  can  be  attributed  to  differences 
in  the  directional  response  qualities  of  the  controlled  vehicles  (i.e.  a 
HMMWV  versus  most  passenger  cars).  The  observed  change  in  driver 
responsiveness  is  assumed  to  represent  typical  human  operator 
adaptation/compensation  behavior  frequently  observed  in  most  man- 
machine  systems. 

•  A  simplified  vehicle  representation  was  generally  sufficient  for  describing 
the  directional  dynamics  of  the  internal  reference  vehicle  used  by  the  driver 
model  for  estimating  its  future  position. 

•  Adaptation  by  the  driver  model  to  changes  in  the  controlled  vehicle 
dynamics  during  more  demanding  ("high-g")  maneuvers  was  found  to  be 
necessary,  provided  the  changes  to  the  vehicle  dynamics  lasted  for  an 
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extended  period  of  time  during  the  maneuver.  Compensation  by  the  driver 
model  was  less  critical  for  maneuvers  producing  similar,  but  short-term, 
variations  in  the  same  vehicle  properties. 

•  Regardless  of  the  observed  variations  exhibited  in  driver  steering  behavior 
during  this  test  program,  or  in  what  has  been  reported  previously  by  others 
in  the  technical  literature,  the  TACOM  model  appears  to  be  quite  capable  of 
replicating  most  of  these  observed  driver  steering  control  behavior  patterns 
through  simple  adjustment  of  two  basic  parameters. 

Secondary  tasks  which  were  undertaken  to  supplement  the  basic  features  present  in  the 
steering  control  model,  and  which  hold  promise  for  further  enhancing  the  present  model 
capabilities,  include  the  following: 

•  development  of  a  path  planning/obstacle  avoidance  algorithm  for  generating 
a  path  input  to  the  steering  control  model  based  upon  a  simplified  geometric 
description  of  the  surrounding  landscape 

•  development  of  a  driver  braking  model  to  represent  how  human  operators 
apply  brake  pedal  force  and  control  to  vehicles  during  deceleration  and 
stopping  maneuvers 

Lastly,  a  sequence  of  handling  tests  conducted  with  the  HMMWV  and  MlOl  trailer 
produced  no  special  problems  for  the  test  driver  in  controlling  and  stabilizing  the 
combination  vehicle,  despite  some  significant  payload  alterations  to  the  trailer  and  its 
dynamic  behavior.  Limiting  the  vehicle  speed  was  the  most  effective  means  for  controlling 
the  more  severe  types  of  trailer  oscillations  introduced  by  extreme  rearward  placement  of 
the  trailer  payload.' 


4.0.  RECOMMENDATIONS 

•  Further  tests  involving  a  small  group  of  vehicles  are  recommended  to  clarify 
certain  interesting  findings  from  this  project  which  seem  to  suggest  that  a 
peculiar  relationship  may  exist  between  the  directional  response  of  the 
controlled  vehicle  and  the  steering  response  of  the  driver.  The  two  test 
drivers  used  in  this  test  program  responded  more  quickly  during  most  of  the 
steering  maneuvers  with  the  HMMWV  test  vehicle  than  that  traditionally 
reported  in  the  technical  literature  for  similar  tests  with  drivers  of  passenger 
cars.  The  relatively  slow  directional  response  of  the  HMMWV  test  vehicle. 
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when  compared  with  a  typical  passenger  car,  may  be  the  principal  reason. 
However,  without  conducting  a  sequence  of  side-by-side  tests  with  the  same 
driver(s)  and  a  group  of  vehicles  having  significantly  different  directional 
response  qualities,  this  hypothesis  will  remain  unproven.  It  is  suggested  that 
a  brief  follow-up  test  program  be  conducted  to  address  this  matter  using  the 
following  group  of  three  vehicles:  1)  a  directionally  sluggish  vehicle,  2)  an 
empty  HMMWV  with  directional  response  properties  faster  than  those  used 
in  this  test  program,  and  3)  a  directionally  "quick"  passenger  car  or 
comparable  vehicle.  The  data  collected  should  be  analyzed  in  the  same 
manner  as  performed  under  diis  project  to  clarify  the  results  and  observations 
reported  here.  This  information  would  improve  TACOM's  ability  to  choose 
appropriate  values  of  parameters  for  the  developed  driver  model  when  used 
to  steer  vehicles  having  more  unusual  directional  control  properties. 

•  The  path  planning  /  obstacle  detection  model  begun  under  this  project  should 
be  extended  and  refined  further  to  provide  additional  capabilities  for  TACOM 
in  using  the  developed  driver  model  with  its  present  land  vehicle  simulations. 
Ideas  and  algorithms  initiated  here  could  also  be  combined  with  similar 
concepts  residing  in  other  navigation  models,  such  as  the  NATO  Mobility 
Model,  to  develop  a  more  sophisticated  computer-based  land  navigation 
capability.  Specialized  tests  could  be  designed  and  conducted  to  help 
develop  and  validate  such  a  model. 

•  The  driver  braking  model  concepts  proposed  in  this  report  should  be  pursued 
further  by  TACOM  to  provide  an  enhanced  capability  for  simulating 
representative  driver  braking  behavior  during  vehicle  stops  or  maneuvers 
involving  controlled  deceleration.  Much  of  the  test  data  collected  under  this 
project  can  be  used  as  a  good  starting  point  for  initial  validation  efforts. 

•  Lastly,  use  of  the  driver  model  developed  here  should  be  considered  as  a  key 
ingredient  for  a  basic  research  program  involving  autonomous  vehicle  and 
tele-operated  vehicle  applications.  An  on-board,  silicon-based  extension  of 
this  work  appears  as  an  obvious  candidate  for  steering  control  of  both 
autonomous  and  (a  special  class  of)  tele-operated  land  vehicles.  Combined 
with  existing  remote  sensing  capabilities,  a  high  performance  "driver  model 
on  a  chip"  concept  is  very  promising.  Although  previous  research  efforts 
have  been  hampered  by  time  delays  in  remote  sensing  and  image  processing, 
improvements  in  the  on-board  steering  controller  and  use  of  "image 
prediction"  schemes  can  improve  overall  system  performance  for  such 
vehicles. 
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5.0. 


DISCUSSION 


5.1.  Background  and  Overview 

The  starting  point  for  the  driver  modelling  research  conducted  under  this  project  was  a 
linear  preview  control  model  originally  proposed  by  Mac  Adam  ^  in  1981.  The  primary 
conclusion  from  that  work  was  that  automobile  driver  steering  control  could  be  represented 
and  modelled  quite  accurately  as  an  optimal  preview  control  strategy  which  attempts  to 
minimize  errors  between  a  desired  previewed  path  and  the  predicted  future  position  of  the 
vehicle  being  controlled.  See  Figure  5-1.  The  driver  model  incorporated  knowledge  of  the 
vehicle  dynamics  (i.e.  the  vehicle  being  controlled)  within  its  structure  and  could  therefore 
project  into  the  future  an  estimate  of  the  vehicle  position  at  an  advanced  point  in  time. 
Simultaneously,  the  use  of  preview  permitted  the  driver  model  to  observe  directly  (i.e. 
"look  ahead  at")  the  corresponding  desired  path  to  follow.  See  Figure  5-2.  The  difference 
between  these  two  future  projections  (predicted  vehicle  position  and  previewed  desired 
path)  corresponded  to  the  previewed  error  signal  minimized  by  the  steering  controller. 
However,  one  additional  refinement  was  proposed  and  found  necessary  in  that  original 
model  to  account  for  human  operator  limitations  in  reacting  to  external  stimuli.  This  other 
ingredient  was  the  presence  of  a  pure  time  delay  accounting  primarily  for  the  neuro¬ 
muscular  transport  delay  of  average  human  operators  and  generally  observed  in  most 
tracking  control  task  experiments  of  man-machine  systems.^’  ^  When  the  proposed 
time  delay  property  was  added  to  the  optimal  preview  control  strategy  outlined  above, 
agreement  between  model  predictions  and  actual  driver/vehicle  measurements  for  several 
different  validations  was  found  to  be  remarkably  good. 

Since  that  original  paper,  the  driver  model  has  been  implemented  in  a  number  of  UMTRI 
computer  programs  used  to  primarily  simulate  vehicle  handling  performance  of  passenger 
cars  and  commercial  vehicles.^’  ^  A  number  of  technical  papers  have  also  been 
published  since  that  time  which  utilized  the  original  model  to  study  problems  associated 
with  "closed-loop"  or  driver  steering  control  of  various  vehicles.^®’ 

In  1985,  the  research  described  within  this  report  was  begun  and  was  aimed  at  extending 
the  original  UMTRI  driver  niodel  to  the  TACOM  vehicle  simulation  environment  while 
simultaneously  adding  other  features  and  c^abilities  not  present  in  the  original  model.  One 
primary  goal  of  this  research  was  to  "generalize"  the  internal  vehicle  dynamics  module  of 
the  driver  model  so  that  use  of  it  with  different  vehicle  configurations  would  be  possible. 
That  is,  the  driver  model  would  be  capable  of  representing,  within  its  own  internal  vehicle 
dynamics  structure,  the  d3mamics  of  a  four- wheel-steered  vehicle  or  a  tracked  vehicle,  for 
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Figure  5-1.  Driver  Control  Strategy:  Minimize  Previewed  Path 
Error. 
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example,  rather  than  just  a  basic  passenger  car  with  front-wheel-only  steering.  In  addition, 
it  was  important  that  the  resulting  steering  control  predictions  made  by  the  driver  model  be 
representative  of  what  actual  drivers  would  likely  produce  under  similar  maneuvering 
scenarios. 

Consequently,  it  was  decided  at  the  start  of  the  project  that  an  initial  investigation  would  be 
first  conducted  to  look  at  how  the  original  UMTRI  preview  model  could  be  adapted  to  a 
wider  variety  of  vehicles  than  just  passenger  cars  and  conventional  trucks  —  the  type  of 
vehicle  it  had  been  primarily  used  for  up  until  that  time.  Because  of  the  UMTRI  model's 
demonstrated  capability  of  accurately  representing  steering  control  behavior  of  passenger 
car  drivers,  it  was  reasoned  that  if  its  internal  vehicle  dynamics  module  could  be 
generalized  to  account  for  a  wider  class  of  vehicles,  it  might  also  do  a  good  job  of 
simulating  more  diverse  driverArehicle  systems  as  well.  The  results  from  that  initial  project 
task  showed  that  generalization  of  the  vehicle  dynamics  module  for  the  UMTRI  model 
would  be  possible  and  that  doing  so  was  a  relatively  straightforward  process.  Section  5.5 
reports  on  that  work. 

Having  found  a  means  for  adapting  the  driver  model  to  a  wider  class  of  vehicles,  the 
remaining  basic  goal  was  to  validate  the  extended  model  through  direct  comparison  with 
measurements  from  driver/vehicle  tests.  Testing  was  accomplished  by  performing  a 
sequence  of  "closed-loop"  driver/vehicle  tests  at  the  Chrysler  Proving  Grounds.  Results 
from  those  tests  and  the  subsequent  model  validation  are  reported  on  in  Sections  5.6  and 
5.7  respectively. 

During  the  course  of  the  project  a  number  of  additional  topics  arose  which  contributed  to 
the  further  extension  and  refinement  of  the  final  model.  These  included: 

•  adaptation  by  the  driver  model  to  lateral  acceleration  due  to  maneuvering 

•  adaptation  by  the  driver  model  to  forward  speed 

•  study  of  roll  motion  as  an  additional  degree  of  freedom  "sensed"  by  the 
driver  model 

•  development  of  an  optional  "path  planning  /  obstacle  avoidance"  algorithm 
capable  of  generating  path  inputs  for  the  driver  model  based  upon  a 
previewed  field  of  obstacles  and  terrain  boundaries 

•  consideration  of  a  proposed  closed-loop  braking  model  for  future 
extensions  to  this  work. 
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These  topics  are  covered  further  within  the  discussion  sections  of  5.8  to  5.10. 

Finally,  installation  of  the  developed  driver  model  into  the  DADS  simulation  program  used 
by  TACOM  is  described  in  section  5.8.  Computer  code  illustrating  the  interface  procedure 
is  listed  in  Appendices  D  and  E. 


5.2.  The  Preview  Model  Concept 

The  importance  of  utilizing  a  preview-based  control  concept  to  model  the  steering  control 
strategy  used  by  drivers  of  land-based  vehicles  cannot  be  over  emphasized.  Researchers 
and  laymen  alike  know  from  simple  observation  and  experience  that  path  control  of  typical 
land  vehicles  relies  heavily  upon  "looking  ahead"  to  observe  a  desired  path  or  direction  of 
travel.  Accordingly,  preview  or  "look  ahead"  characteristics  should 

seemingly  be  an  inherent  part  of  any  mathematical  model  which  attempts  to  represent  the 
basic  steering-control  characteristics  of  human  operators.  Thus,  three  key  reasons  are  seen 
as  arguments  for  a  preview-based  control  approach  to  modelling  the  driver  steering  control 
process: 

•  Human  operators  are  known  to  employ  preview  in  their  steering  control 
strategy  and  therefore  any  corresponding  model  should  include  it 

•  The  use  of  preview  allows  the  "physics"  of  the  driving  control  process  to  be 
explained  simply  and  directly  in  terms  of  regulating  previewed  path  errors 
alone  —  something  that  anyone  who  has  driven  an  automobile  can  relate  to 
and  understand. 

•  future  extension  of  a  preview-based  model  to  incorporate  path  planning  and 
navigation  algorithms/models  within  a  single  overall  driver  model  structure 
is  a  natural  extension  (physically  and  mathematically)  of  the  project  work 
reported  on  here. 

References  20  -  23,  49  provide  additional  examples  of  preview-based  driver  modelling 
which  have  been  published  previously  in  the  technical  literature. 
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5.3.  The  Preview  Model  vs.  Experimental  Observations  of  Man/Machine  Systems 

A  pertinent  question  is  whether  or  not  the  developed  preview  control  model  is  in 
fundamental  agreement  with  known  experimental  measurements  and  findings  regarding 
man/machine  systems  and  their  interactions.  A  well-known  principle  within  the 
man/machine  arena,  and  one  used  to  describe  the  compensation  /  adaptation  properties  of 
human  operators  when  interacting  with  different  machines,  is  the  so-called  "cross-over 
model"  principle.'^  This  principle  is  really  an  experimental  observation  that  when  human 
subjects  attempt  to  regulate  simple  first  and  second  order  plant  dynamics  during  laboratory 
tracking  task  experiments,  the  measured  transfer  function  of  the  combined  man/machine 
system  exhibits  an  invariant  property  within  a  certain  range  of  frequencies.  (The  term 
"cross-over  model"  derives  from  the  fact  that  a  simple  mathematical  expression,  coc  e"J®^/ 
jo),  can  be  used  to  frequently  curve  fit  the  experimental  measurements  collected  from  such 
laboratory  tests.)  This  invariant  form  of  the  combined  man/machine  transfer  function  is 
seen  in  Figure  5-3.  The  top  portion  of  Figure  5-3  shows  a  block  diagram  depicting  the 
typical  laboratory  tracking  task  experimental  arrangement.  In  these  experiments,  human 
subjects  are  instructed  to  maintain  an  error  signal,  e,  at  a  small  or  zero  value  by  movement 
of  a  "joystick"  controller,  u.  The  error  signal  presented  to  the  subject  is  simply  the 
difference  between  a  random  input  waveform,  f,  and  the  output  of  the  plant,  x,  the  subject 
is  being  asked  to  regulate. 

When  similar  experiments  are  conducted  with  drivers  in  full-scale  vehicle  tests  or 
sophisticated  moving-base  simulators,^^’  the  complexity  of  the  plant  (vehicle) 

dynamics  is  now  increased.  Measurements  then  show  that  the  same  man/machine  transfer 
function  becomes  altered  to  that  seen  in  Figure  5-4.  From  this  we  note  several  things. 
First,  the  slope  of  the  gain  function  at  low  frequencies  is  significantly  increased  from  that 
of  the  laboratory  tests;  second,  the  low  frequency  phase  lag  is  also  increased,  thereby 
producing  a  characteristic  parabolic-like  shape  of  the  total  phase  plot;  and  finally,  the  cross¬ 
over  frequency,  coc,  is  increased.  (The  basic  laboratory  cross-over  model  result  is  included 
in  the  figure  for  direct  comparison.)  However,  even  though  the  frequency  responses 
become  altered  and  shifted,  the  shape  of  all  the  curves  in  the  vicinity  of  their  respective 
cross-over  frequencies,  coc.  remains  unchanged,  with  each  maintaining  a  slope  of  -20 
db/decade.  The  key  point  to  be  made  here  is  that  unless  a  driver  model,  regardless  of  its 
origin,  can  pass  at  least  the  elementary  validation  test  of  exhibiting  "cross-over  moder'-like- 
behavior  in  the  vicinity  of  its  cross-over  frequency,  the  model's  legitimacy  in  terms  of  its 
ability  to  mimic  human  operator  behavior  will  generally  be  held  in  question.  Obviously,  if 
a  particular  model  can  not  only  exhibit  "cross-over  model"  behavior  within  the  vicinity  of 
its  cross-over  frequency,  but  can  fit  experimental  measurements  at  other  frequencies  as 
well,  its  validity  is  further  enhanced. 
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Figure  5-3.  Typicai  Laboratory  "Cross-Over  Modei” 
Measurements  of  Human  Operators  in 
Compensatory  Tracking  Task  Experiments 
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Figure  5-4.  Typical  Full  Scale  Road  Measurements  of 

Driver/Vehicle  Systems  and  Comparison  with 
Laboratory  Tracking  Task  Measurements. 
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The  importance  of  these  observations  for  the  TACOM  driver  model  is  that  the  very  same 
transfer  function  characteristics  seen  for  these  full-scale  experimental  measurements  are 
predicted  by  the  TACOM  model.  To  demonstrate,  corresponding  example  calculations 
from  the  model  are  shown  in  Figure  5-5  using  1)  a  large  passenger  car  (4000  lb),  and  2)  a 
loaded  HMMWV  (7500  lb)  to  represent  the  dynamics  of  the  controlled  vehicle  in  each  case. 

It  can  be  shown  that  adjustment  of  the  transfer  function  characteristics  seen  in  Figure  5-5 
is  easily  controlled  through  two  basic  driver  model  parameters.  The  first  parameter  which 
determines  the  amount  of  preview  or  "look  ahead"  time  used  by  the  model,  controls  the 
slope  of  the  low  frequency  end  of  the  combined  transfer  function.  Increasing  the  preview 
time  decreases  the  slope  at  low  frequencies  and  simultaneously  decreases  the  corresponding 
phase  lag  as  well.  The  other  basic  parameter  determines  the  amount  of  neuromuscular  time 
delay  in  the  driver  model  and  adjustment  of  it  controls  the  frequency  at  which  cross-over 
occurs  in  the  combined  transfer  function  plot  Consequently,  a  wide  variety  of  basic  man- 
machine  behavior,  as  defined  by  such  experimental  measurements,  can  be  accurately 
represented  with  this  model  through  simple  adjustment  of  only  two  basic  parameters.  Not 
surprisingly,  the  two  model  parameters  that  are  key  to  controlling  these  adjustments  are 
also  parameters  which  represent  the  two  central  assumptions  used  in  the  development  of  the 
model:  1)  recognition  and  use  of  preview  within  the  model,  and  2)  presence  of  a  driver 
time  delay. 

Prior  to  leaving  this  discussion,  it  should  be  noted  that  an  analogous  time-domain 
validation  of  the  model  is  presented  in  Section  5.7  where  driver/vehicle  test  track 
measurements  for  the  HMMWV  are  compared  with  model  predictions.  Furthermore,  a 
portion  of  those  test/model  comparisons  show  new  results  for  a  driverA^ehicle  system 
operating  under  unusual  nonlinear  operating  conditions  and  which  heretofore  have  not  been 
reported  in  the  general  literature.  The  measurements  presented  there  offer  further 
experimental  confirmation  of  the  validity  of  the  driver  model  in  predicting  steering  control 
behavior  of  drivere  operating  at  or  near  limit  maneuvering  conditions. 


5.4.  Mathematical  Formulation  of  the  Preview  Control  Model 

The  material  in  this  section  shows  the  mathematical  development  of  the  preview  control 
model  and  closely  follows  that  of  reference  1.  The  basic  "computational  mechanics"  of  the 
model  is  to  first  calculate,  at  each  point  in  time,  the  steering  control,  u®,  which  will 
minimize  the  mean  squared  error  between  a  desired  path  input,  f,  and  the  projected  future 
lateral  displacement  of  the  vehicle,  y,  over  a  specified  preview  time  interval,  T.  The 
"optimal"  control,  u®,  is  then  delayed  in  time  by  an  amount  x  seconds.  The  time  delay  is 
used  to  represent  the  effective  neuromuscular  lag  and  characteristic  limitation  of  the  human 
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Figure  5-5.  TACOM  Driver  Model  Predictions. 


operator  in  responding  to  external  stimuli.  The  delayed  steering  control,  u,  is  then  used  to 
steer  the  vehicle.  This  basic  sequence  is  oudined  in  Figure  5-6. 

As  will  be  seen  in  the  development  which  follows,  the  model  is  able  to  estimate  the  future 
response  of  the  vehicle  being  controlled  by  utilizing  an  internal  linearized  dynamical 
representation  of  that  vehicle  within  its  own  structure.  Consequently,  the  driver  model 
includes  an  internal  "understanding"  or  "mapping"  of  the  likely  vehicle  response  resulting 
from  a  particular  steering  control  input.  Obviously,  the  better  the  internal  linearized  model 
is  in  representing  the  vehicle  being  controlled,  the  better  will  be  the  estimate  of  the  projected 
vehicle  response. 

The  resulting  driver  model  then  has  certain  basic  features.  First,  the  model  incorporates 
preview  to  "look  ahead"  and  anticipate  the  desired  path  to  follow.  Second,  the  driver 
model  possesses  an  internal  linearized  representation  of  the  vehicle  being  controlled  and 
uses  that  dynamical  representation  to  predict/estimate  the  vehicle  position  and  response  at 
future  times.  Third,  the  control  strategy  used  by  the  model  is  to  minimize  the  previewed 
error  between  the  desired  path  input  and  the  future  estimated  vehicle  position.  And  finally, 
the  steering  control  obtained  from  the  error  minimization  calculation  is  delayed  in  time  to 
account  for  human  operator  neuromuscular  limitations  in  reacting  to  external  stimuli. 

These  basic  notions  can  all  be  expressed  mathematically  within  the  context  of  linear  system 
theory.  Following  the  mathematical  formulation  of  the  problem  from  references  1  and  2, 
we  have  for  a  given  linear  system,* 

X  =  Fx  +  gu  (5.4-1) 

y  =  “>’■*  (5.4-2) 


where, 

X  is  the  n  X  1  state  vector 

y  is  the  scalar  output  related  to  the  state  by  the  n  x  1  mT  constant  observer  vector 
transpose 

F  is  the  constant  n  x  n  system  matrix 
g  is  the  constant  n  x  1  control  coefficient  vector 
and 

u  is  the  scalar  control  variable. 


Bold  face  type  denotes  matrices  and  vectors. 
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Figure  5-6.  Sequence  of  Driver  Model  Calculations 
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We  would  like  to  find  the  control,  uO(t),  which  minimizes  a  local  performance  index, 


^t+T 

J  =  {[f(Tl)-y(ll)PW(Tl-t)}dTl 

(5.4-3) 

over  the  the  current  preview  time  interval  (t,  t  +  T)  where, 

W  is  an  arbitrary  weighting  function  over  the  preview  interval  (selected  as  a 
constant  1.0  for  all  of  this  discussion) 

and, 

f  is  the  previewed  input. 

The  previewed  output,  y('n),  is  related  to  the  current  state,  x(t),  and  fixed  control,  u(t), 
over  the  preview  interval  (t,  t+T),  by 

oo 

y(il)  =  mT  [I  +  X  F”  (Tl-t)”/  n!]  x(t) 

n^l 

oo 

+  (ll-t) mT[I  +  X  F"  (n-t)"/  (n+1)!]  g  u(t) 

n=l  (5.4-4) 

The  matrix. 


I  +  X  F"  (Tl-t)"/n! 

n=l 

is  simply  the  state  transition  matrix  for  the  linear  system,  F,  and  is  frequently  denoted  as 
0(Ti,t). 

When  the  above  general  formulation  is  applied  to  the  driver/vehicle  path  following 
problem,  F  and  g  represent  the  dynamics  of  the  controlled  vehicle,  f  is  associated  with  the 
desired  path  input,  and  y  with  the  lateral  displacement  of  the  vehicle. 

Rernming  to  the  general  formulation,  the  necessary  condition  that  the  derivative  of  J  with 
respect  to  the  control  variable,  u,  be  zero,  leads  to  the  equation  for  the  optimal  control,  u®, 
given  by. 
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u"  (t)  =  [ J  I  f(Tl)  -  mf  [I  +  £  F"  /  n!]  x(t)  | 

oo 

.  I  (11-t)  mT  [I  +  5;  F"  (ii-t)”/  (n+1)!]  g  j  W(il-t)  dn  j 


/  [f  I  (Tl-t)  mT  [I  +  F"  (il-t)"/  (n+1)!]  g  |  V(Tl-t)  dr]] 


(5.4-5) 


Because  of  the  need  to  subsequently  apply  this  formulation  to  systems  containing 
"imperfect"  human  operators  which  possess  known  reaction  time  limitations  and  cannot 
therefore  be  expected  to  exhibit  optimal  control  behavior,  an  alternate  but  mathematically 
equivalent  formulation  of  equation  (5.4-5)  is  shown  below.  This  alternate  formulaticin 
directly  involves  the  previewed  error  quantity,  e(Ti),  which  is  being  minimized  in  the 
original  performance  index  of  equation  (5.4-3).  The  same  optimal  solution,  uO(t),  can 
therefore  be  expressed  in  terms  of  any  current  nonoptimal  control,  u(t),  and  the  previewed 
error,  e(Ti),  as. 


uO(t)  =  u(t)  -I- 


n+T 

Jt 


e(Tl)  A(Ti)W(Ti-t)dT| 


n+T 

J  A^(r\)  W(Ti-t)  dT| 


(5.4-6) 


where. 


and. 


A(11)  =  (Ti-t)  mT  [I  +  J  F”  (Ti-t)"/  (n+1)!]  g 

11=1 


e(il)  =  f(n)  -  mT  [I  +  5;  F“  (Tl-t)"/  n!]  x(t)  -  u(t)  A(ti) 

n=l 
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In  this  particular  formulation,  the  cmrent  control  is  modified  only  in  response  to  a  nonzero 
function  of  the  previewed  output  error,  and  thereby,  is  analogous  to  an  integral  controller. 
Note  that  the  generality  of  the  mathematics  presented  above  allows  it  to  be  applied  to  a 
variety  of  control  problems,  assuming  the  controlled  dynamical  system  can  be  expressed  in 
terms  of  equations  (5.4-1)  and  (5.4-2). 

In  order  to  apply  this  generalized  formulation  to  the  driverArehicle  path  following  problem, 
the  F  and  g  matrices  must  be  associated  with  the  directional  dynamics  of  the  vehicle  being 
controlled.  (In  reference  1,  F  and  g  represent  the  directional  dynamics  of  a  two-degree-of- 
freedom  automobile.)  In  addition,  the  resulting  optimal  control,  uO(t),  is  assumed  to  be 
delayed  an  amount  x  seconds  to  account  for  the  known  neuromuscular  delay  of  the  driver. 
From  this,  the  steering  control  for  the  driver  model  finally  becomes, 

u  (t)  =  uO  (t)  •  e"*'^  (5.4-7) 

where,  e"^'^,  is  the  driver  time  delay,  and  u®  (t)  is  given  by  equation  (5.4-5  or  5.4-6). 

The  final  steering  control  law  is  noteworthy  for  several  reasons.  First,  it  shows  a  direct 
dependence  upon  the  dynamics  of  the  controlled  system  (vehicle)  through  the  presence  of  F 
and  g  in  equation  (5.4-5).  This  is  important  for  driverA^ehicle  systems  since  we  know 
from  experimental  evidence  that  human  operators,  as  part  of  man/machine  systems, 
demonstrate  great  capacity  for  sensing  and  adapting  to  changes  in  the  dynamics  of  the 
machine  being  controlled.^’  Thus,  when  the  driver  model  is 

used  to  steer  different  types  of  vehicles,  or,  when  changes  in  the  dynamics  of  the  vehicle 
occur  due  to  operating  conditions,  those  vehicle-related  effects  are  reflected  directly  in  the 
driver  model  through  the  F  and  g  matrices  appearing  in  the  control  law.  (For  applications 
involving  significant  nonlinearities,  or,  parameters  in  the  F  and  g  matrices  that  may  vary 
significantly  over  time,  the  F  and  g  matrices  may  be  updated  continuously  or  intermittently 
to  account  for  and  represent  the  adaptive  control  behavior  of  drivers.)  Secondly,  the 
characteristic  behavior  of  human  operators  to  utilize  preview  as  part  of  their  control 
strategy,  and  the  fact  that  human  operators  also  have  limited  reaction  times,  are  both 
incorporated  in  the  model  through  the  presence  of  the  preview  time  parameter,  T,  and  time 
delay  parameter,  x,  appearing  in  equation  (5.4-5)  and  (5.4-7).  Variations  in  these  two 
parameters  can  markedly  affect  the  response  and  stability  properties  of  the  closed-loop 
driver/vehicle  system.  Furthermore,  as  noted  in  section  5.3,  adjustment  of  these  same  two 
parameters  facilitates  curve  fitting  the  frequency  response  characteristics  of  the 
driverA^ehicle  model  to  experimental  data  in  the  frequency  domain. 

The  driver  model  equations,  (5.4-6)  and  (5.4-7),  can  also  be  expressed  in  terms  of  a 
conventional  control  system  block  diagram  as  seen  in  Figure  5-7.  In  this  diagram,  H 
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Figure  5-7.  The  Driver  Modei  Shown  in  a  Conventionai  Biock  Diagram  Format 


represents  the  time  delay  block  of  the  human  operator  and  is  given  by  H  =  e’^'^.  The  block 
(vector)  denoted  as  G  represents  the  directional  dynamics  of  the  vehicle  (internal  to  the 
driver  model)  and  relates  the  vehicle  state  response,  x,  to  the  driver  steering  output,  u.  The 
scalar  constant,  a,  appearing  in  two  of  the  blocks  is  given  by. 


/“t+T  ^  «»  1  2  T 

a  =  I  I  (Ti-t)  mT  [I  +  X  F”  (ii-t)"  /  (n+1)!]  g  j  dn  J 


Vt 


(5.4-8) 


and  the  constant  gain  vector,  b,  is  given  by  the  expression. 


/"t+T  o® 

b=l  (ii.t)m^[I  +  XF"(T1-t)"/(n+l)!]g 


•  mT[I-f.^F”(ri-t)"/n!]dn 

1^1 


(5.4-9) 


The  scalar,  a,  represents  the  driver's  ability  to  predict  that  component  of  the  future  response 
of  the  vehicle  deriving  only  from  the  current  steering  control  input.  The  constant  gain 
vector,  b,  represents  the  driver's  ability  to  predict  that  component  of  the  future  vehicle 
response  deriving  only  from  the  present  state  of  the  vehicle. 

The  time  history  input  to  the  block  diagram,  fp(t),  is  given  by. 


rt+T  o® 

fp  (t)  =  y  f(il)  (n-t)  mT  [I  +  X  F"  /  (n+l)!]  g  dn 

(5.4-10) 

The  quantities  yo(t),  yu(0.  yp(t).  ep(t),  and  fp(t)  appearing  in  this  diagram  can  then  be 
interpreted  as: 

fp(t)  a  weighted  average  of  the  previewed  input  (forcing  function)  over  the 
preview  interval  (t,  t+T) 

yo(t)  a  weighted  average  of  the  predicted  output  response  over  the  preview 
interval  due  to  the  current  system  state,  x(t) 
yu(t)  a  weighted  average  of  the  predicted  output  response  over  the  preview 
interval  due  to  the  current  control,  u(t) 
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yp(t)  a  weighted  average  of  the  total  predicted  output  response  over  the  preview 
interval 

ep(t)  a  weighted  average  of  the  previewed  error  over  the  preview  interval 

Note  that  the  above  block  diagram  and  associated  variables  apply  to  the  complete  preview 
control  formulation,  wherein  the  minimization  of  the  previewed  error  signal  is  occurring 
over  the  entire  preview  interval.  If  a  simplification  is  introduced,  so  that  the  previewed 
error  signal  is  being  minimized  or  nulled  out  only  at  a  single  point,  T*  seconds  ahead  in 
time,  the  so-called  "single-point"  version  of  the  preview  model,  as  described  in  reference  1, 
is  obtained.  See  the  similar  block  diagram  of  Figure  5-8  for  this  model. 

The  "single-point"  model  is  derived  from  the  previous  mathematical  formulation  by  letting 
the  arbitrary  weight  function,  W(T|-t),  be  equal  to  the  Dirac  delta  function,  5(T*).  In  this 
diagram,  the  corresponding  quantities  y(t+T*),  f(t+T*),  and  e(t+T*)  are  more  directly  and 
easily  understood  as  the  previewed  plant  output  T*  seconds  ahead,  the  previewed  input  T* 
seconds  ahead,  and  the  previewed  error  signal  T*  seconds  ahead,  respectively.  The 
corresponding  constant  gain,  a*,  is  then  provided  by  the  somewhat  simpler  expression, 

oo 

a*  =  (T*)  mT  [I  -H  ^  F"  (T*)"/  (n+1)!]  g 

11=1  (5.4-11) 

and  the  constant  feedback  gain  vector,  b*,  is  seen  to  be. 


b*=  F"(T*)"/n!] 

n=l  (5.4-12) 

The  "single-point"  model  of  Figure  5-8  is  shown  here  primarily  to  present  a  simpler  and 
more  obvious  version  of  the  analogous  diagram  in  Figure  5-7.  Reference  1  also  includes  a 
similar  version  of  the  "single-point"  model  in  its  discussion. 


5.5.  Application  of  the  Preview  Control  Model  to  Steering  of  Basic  Land  Vehicles 

Attention  is  now  turned  to  applying  the  generalized  results  of  section  5.4  to  the  problem  of 
directional  and  path  control  of  land  vehicles  by  human  drivers.  The  vehicle  directional 
dynamics  equations  (F  and  g  matrices  of  section  5.4)  appearing  in  the  original  UMTRI 
driver  model  ^  are  extended  here  to  provide  for  single-unit  vehicles  controlled  by  three 
possible  schemes:  a)  control  through  steering  of  the  front  and/or  rear  wheels,  b)  control  by 
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Figure  5-8.  The  "Single-Point"  Version  of  the  Driver  Model 


application  of  a  pure  yaw  moment  input,  and  c)  control  by  means  of  both  an  applied  lateral 
force  and  accompanying  yaw  moment.  See  Figure  5-9.  Case  a)  applies  to  the  conventional 
passenger  car  and  single-unit  vehicles  such  as  the  HMMWV.  Case  b)  is  primarily  intended 
for  applications  involving  tracked  vehicles  wherein  the  control  torque.  Me,  is  applied  by 
means  of  side-to-side  longitudinal  forces  deriving  from  differential  track  speeds.  Case  c)  is 
a  generalized  formulation  intended  to  cover  a  broader  range  of  future  control  possibilities  as 
well  as  those  represented  by  Cases  a)  and  b). 

For  example.  Case  c)  can  duplicate  a  steered-wheel  vehicle  response  by  simply  defining  the 
control  force  as  the  product  of  the  control  variable  and  the  tire  cornering  stiffness  and  then 
applying  the  control  force  at  the  forward  non-steered  wheel  location.  (The  force  control 
variable  is  in  fact  the  steering  magnitude,  scaled  by  the  cornering  stiffness  of  the  tire,  of  a 
an  equivalent  steerable  wheel.)  Likewise,  Case  c)  can  be  used  to  duplicate  a  yaw  moment 
control  scheme,  as  given  by  Case  b),  by  using  a  control  force  located  at  a  very  large 
forward  distance,  d,  ahead  of  the  mass  center.  This  results  in  a  sizeable  yaw  moment 
control  accomplished  through  use  of  a  very  small  lateral  control  force. 

Looking  first  at  the  case  of  a  single-unit  vehicle  having  both  front  and  rear  wheel  steering, 
the  linearized  vehicle  dynamic  equations  are  shown  here: 

y'  =  V  -H  U  \jr  (5.5-1) 

V  =  [-2(Caf+Car)/mU]v  +  [2(bCar-aCaf)/mU-U]r 

(2  Caf  /  m)  5f  +  (2  Car  /  m)  5r  (5.5-2) 


r'  =  [2(bCar  -  aCaf)/IU]v  +  [-2(a2Caf  +  b2Car)/IU]r 

+  (2aCaf/D5f  -  (2bCar/D5r  (5.5-3) 

X|/*  =  r  (5.5-4) 
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Directional  Control  Through  Steering  of  Front  and/or  Rear  Wheels 


Directional  Control  Through  Application  of  a  Control  Moment,  M  ^ 


Directional  Control  Through  Application  of  a  Control  Force,  F^ 


Figure  5-9.  Three  Control  Schemes 
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where. 


'  denotes  differentiation  with  respect  to  time 
y  is  the  inertial  lateral  displacement  of  the  vehicle  mass  center 

V  is  the  lateral  velocity  in  the  vehicle  body  axis  system 
r  is  the  yaw  rate  about  the  vertical  body  axis 

Y  is  the  vehicle  heading  (yaw)  angle 

5f  is  the  front  tire  steer  angle,  control  variable 
5r  is  the  rear  tire  steer  angle,  control  variable 
and  the  parameters  appearing  in  equations  (5.5-1)  ->  (5.5-4)  are: 

U  forward  vehicle  velocity 

Caf,  ar  front  and  rear  tire  cornering  stiffnesses 

a,  b  forward  and  rearward  locations  of  tires  from  the  vehicle  mass  center 

m,  I  vehicle  mass  and  yaw  inertia 

The  diagram  of  Figure  5-10  further  supplements  these  definitions. 

The  above  equations  can  be  simplified  somewhat  to  represent  rear  wheel  steering  system 
implementations  in  which  the  rear  wheels  are  proportionately  slaved  to  the  front  wheel 
angle  by  a  gain  constant,  k, 

5r  =  k6f  (5.5-5) 

and  thereby  eliminating  5rw  as  a  second  independent  control  input. 

By  also  adding  lateral  force,  1?  / m,  and  yaw  moment,  DU,  control  terms,  the  equations 
(5.5-1)  ->  (5.5-4)  can  be  written  in  a  more  general  form  that  now  encompasses  all  the  cases 
shown  in  Figure  5-9: 
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y'  =  V  +  U  Y  (5.5-6) 

V  =  [-2(Caf  +  Car)/mU]v  +  [  2(b  Car"  aCaf)/m U -  U  ]  r 

+  {  A  [  2(Caf  -H  k  Car)/m]  5/m  }  Uc  (5.5-7) 

r’  =  [2(bCar  -  aCaf)/IU]v  +  [-2(a2Caf  +  b2Car)/IU]r 

{C[2(aCaf  -  kbCar)/I]  +D/I}uc  (5.5-8) 

V  =  r  (5.5-9) 

where  now, 


Uc  takes  on  the  role  of  the  general  purpose  control  variable  (uc  may  be 
interpreted  as  either  front  wheel  steer  angle,  lateral  control  force,  or  yaw 
moment  control,  depending  upon  the  values  of  the  control  parameters  A  , 
5,  C  ,  and  JD  ). 

and, 

A  ,B  ,C  ,  and D  are  "control  coefficients"  specified  to  allow  various  types  of 
control  schemes  to  be  represented  in  the  above  equations. 

For  example,  by  specifying  A  and  C  as  1.0  and  k  =  5  =  D  =  0,  the  conventional  front 
wheel  steered  vehicle  is  represented  with  Uc  interpreted  as  the  front  wheel  steer  angle 
control  variable. 

By  specifying  A=B  =C  =  0  and  D  as  1.0,  a  vehicle  controlled  by  a  pure  yaw  moment 
control  (e.g.,  a  tracked  vehicle)  is  represented  with  Uc  now  interpreted  as  the  yaw  moment 
control  variable.  In  the  case  of  the  tracked  vehicle,  the  sum  of  Caf  and  Car  would  be 
interpreted  as  an  equivalent  lateral  force  "cornering  stifftiess"  of  the  track  element  due  to 
track  sideslip.  Different  fore-aft  values  of  Caf  and  Car  could  be  designated  to  move  the 
center  of  track  side  force  forward  or  rearward  from  the  mid-wheelbase  position,  or 
equivalently,  assign  different  levels  of  "front"  and  "rear"  (single  point)  track  side  forces. 
The  a  and  b  parameters  would  be  used  to  locate  the  tracked  vehicle's  fore-aft  mass  center 
location  with  respect  to  the  equivalent  "front"  and  "rear"  side  force  locations.  The  resulting 
yaw  moment  control  variable,  Uc,  calculated  by  the  steering  model  could  then  be  expressed, 
if  desired,  in  terms  of  a  driver  steering  control  movement  through  knowledge  of  the 
steering  control  gain  (e.g.,  inches  or  degrees  of  stick  movement  per  differential  longitudinal 
track  force)  and  the  lateral  spacing  of  the  tracks. 
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The  last  control  option,  for  representing  a  lateral  force  control  scheme,  A  and  C  are 
selected  as  0,  B  =  1.0,  and  D  is  the  distance  forward  of  the  vehicle  mass  center  at  which 
the  lateral  control  force,  Uc,  acts. 

Equations  (5.5-6)  ->  (5.5-9)  represent  the  internal  set  of  vehicle  dynamics  utilized  by  the 
driver  model  for  the  category  of  single-unit  vehicles.  (The  FORTRAN  driver  model  code 
appearing  in  Appendix  D  utilizes  these  equations  as  the  basis  for  its  internal  vehicle 
dynamics  model.)  The  above  equations  can  be  expressed  in  state  space  terminology  by 
defining  the  F,  g,  x,  and  m  matrices  of  section  5.4  as, 

"  0  1  0  u 

0  -2(CaffCar)/mU  2(b  Car  a  Caf) / m U  -  U  0 

F  = 

0  2(bCar-aCaf)/IU  -2(a2Caffb2Car)/IU  Q 

_0  0  1  0. 


0 

■y 

■  1  ■ 

g  = 

A[2(Caf+kCar)/m]+5/m 

V 

m  = 

0 

C[2  (Caf-kbCar)/I]+/>/I 

r 

0 

0 

-0- 

For  the  case  of  an  articulated  vehicle,  a  similar  but  lengthier  set  of  equations  is  produced 
and  is  shown  in  Appendix  A.  The  equations  in  Appendix  A  are  for  a  linear,  constant 
velocity  articulated  vehicle  having  front  steerable  wheels  as  well  as  an  articulation  joint 
torque  as  control  variables  —  similar  in  concept  to  a  simplified  LVS  (MK48  Series).  These 
equations  could  be  used  in  a  manner  identical  to  those  just  presented  to  represent  the 
internal  vehicle  model  of  the  driver  if  greater  accuracy  was  required,  for  example,  to  study 
driver  steering  interactions  with,  or  dependencies  upon,  the  dynamics  of  the  rear  unit.  In 
this  way,  the  more  extensive  set  of  articulated  vehicle  equations  could  be  used  to  represent 
a  driver's  more  complete  "understanding"  of  the  contributions  of  the  rear  unit  (or  even  the 
articulation  controller  torque)  to  the  directional  control  of  the  total  vehicle. 

In  general  though,  driver  steering  control  of  most  articulated  vehicles  can  be  adequately 
represented  by  the  single-unit  equations  presented  above.  When  doing  so,  the  following 
interpretations  and  modifications  of  the  vehicle  parameters  in  the  single-unit  equations  need 
to  be  applied: 
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•  the  mass,  m,  and  yaw  inertia,  I,  now  represent  the  mass  and  inertia  of  the 
lead  unit  plus  that  "contributed"  by  the  static  vertical  hitch  load  from  the 
second  unit 

•  the  a  and  b  parameters  locating  the  fore/aft  positions  of  the  front  and  rear 
suspension  centerlines,  must  now  be  altered  to  reflect  the  additional  static 
vertical  hitch  load  from  the  second  unit 

•  the  tire  cornering  stiffness  parameters  need  to  reflect  any  changes  resulting 
from  the  increas^  vertical  loads 

Referring  to  Figure  5-11,  we  see  that  the  nominal  single-unit  parameters  appearing  at  the 
top  of  the  figure,  become  altered  to  those  in  the  bottom  portion  of  the  figure  due  to  the 
presence  of  the  vertical  hitch  load  contributed  from  the  second  unit.  The  driver  model  is 
then  viewed  as  steering  a  single-imit  vehicle  having  a  total  mass,  mg  +  Fh,  with  a  new 
"total  c.g."  location  given  by  the  modified  parameters  a'  and  b'.  The  tire  cornering 
stiffnesses  that  now  apply  should  also  correspond  to  the  new  vertical  tire  loads  FzT  and 
Fz2'.  (A  more  sophisticated  and  accurate  method  for  representing  the  coupled  inertial 
effects  of  multiple  masses  is  described  by  Wehage.^^) 

If  a  vehicle  has  more  than  one  tire  per  side  at  a  front  or  rear  suspension  location,  the 
particular  front/rear  cornering  stiffness  parameter  used  in  the  model  (Caf  or  Car )  should 
represent  the  sum  of  all  the  tire  cornering  stiffnesses  per  side  at  the  frontfrear  suspension 
location.  Similarly,  the  a  and  b  parameters  locating  the  total  mass  center  of  the  vehicle 
should  be  from  the  centerline  of  the  axle  set  for  a  particular  front  or  rear  suspension. 

To  illustrate  the  types  of  responses  that  are  representative  of  the  driver  model  when  steering 
a  single  unit  vehicle,  a  sequence  of  example  calculations  are  now  presented  for  two  single 
unit  vehicles  having  significantly  different  sets  of  vehicle  directional  dynamics.  The  first 
vehicle  is  a  conventional  compact  passenger  car  weighing  3000  lb;  the  other  vehicle  is  a 
HMMWV  loaded  to  a  total  gross  weight  of  7500  lb.  The  baseline  maneuver  for  the 
examples  that  follow  is  a  conventional  12-foot  lane-change  performed  at  a  speed  of  50  mph 
(73.3  fl/sec)  over  a  forward  travel  distance  of  100  feet.  The  driver  model  was  used  to  steer 
the  vehicle  over  this  desired  course  and  utilized  a  preview  parameter  of  1.50  seconds.  The 
driver  time  delay  parameter  was  fixed  at  0.25  seconds.  Figure  5-12  lists  each  of  these 
parameters  and  shows  a  diagram  of  the  desired  path  used  in  the  example  calculations.  The 
vehicle  parameter  values  seen  in  Figure  5-12  are  based  upon  measurements  and  reasonable 
estimates.^^ 

Identical  calculations  were  performed  for  each  vehicle  for  four  different  control  cases 
corresponding  to  the  following:  A)  control  through  front  wheel  steering  only,  A)  control 
through  front  and  rear  wheel  steering,  with  the  front-to-rear-wheel  ratio  parameter,  k,  set  at 
0.75,  C)  control  by  means  of  an  applied  yaw  control  torque,  and  D)  control  through  means 
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Figure  5-11.  Interpretation  of  the  Single-Unit  Model  Parameters 
when  Steering  an  Articulated  Vehicle. 


"Desired"  Path  Input  for  Example  Lane-Change  Maneuver: 
150' 
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Figure  5-12.  Parameter  Values  for  Example  Calculations 
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of  an  applied  lateral  control  force.  In  cases  C  and  D,  none  of  die  wheels  are  steered.  The 
above  cases  correspond  closely  with  those  seen  earlier  in  Hgure  5-9.  (The  HMMWV  is  a 
specific  front-only  steering  vehicle  and  reference  to  it  in  these  other  example  cases  is  for  the 
purpose  of  only  providing  a  distinctly  different  set  of  directional  dynamics  for  comparison 
with  the  passenger  car  directional  dynamics.)  Additional  analyses  appear  in  the  1986 
Interim  Technical  Report  for  this  project 

The  example  calculations  which  follow  utilize  equations  (5.5-6)  -  (5.5-9)  for  simulating  the 
vehicle  directional  dynamics,  and  equations  (5.4-6)  -  (5.4-7)  for  simulating  the  driver 
steering  control.  The  equations  were  implemented  in  a  digital  simulation.  Referring  to 
Figures  5-13  and  5-14,  example  time  history  results  are  seen  for  the  case  of  conventional 
front  wheel  only  steering.  The  earlier  "control  coefficients"  (A,  B,  C,  D)  seen  in  the 
vehicle  dynamics  equations  have  the  values  here  of  1.0,  0.0,  1.0,  and  0.0  respectively. 
Also,  the  front-to-rear- wheel  steering  ratio,  k,  is  set  equal  to  0.0  in  this  first  example.  As 
seen  in  Figure  5-13,  the  trajectories  of  both  simulated  driver/vehicle  systems  track  the 
desired  path  quite  well  (bottom  portion  of  the  figure),  even  though  significantly  different 
steering  control  waveforms  are  required  by  the  driver  model  for  each  vehicle  (top  portion). 
This  is  characteristic  of  the  adaptive  properties  of  the  driver  model  (and  most  drivers)  since 
the  directional  dynamics  of  each  vehicle  are  completely  different  but  still  accounted  for  by 
the  driver  model.  The  corresponding  time  histories  of  Figure  5-14  show  lateral  acceleration 
and  heading  (yaw)  angle  results  for  each  vehicle  during  the  course  of  the  simulated 
maneuver.  The  reduced  level  of  damping  exhibited  by  the  HMMWV-driver  system,  in 
comparison  to  the  passenger  car-driver  system,  is  not  unusual  since  the  HMMWV 
directional  dynamics  are  significantly  more  oversteer  (-3  deg/g)  than  the  passenger  car  (1.2 
deg/g),  and  such  tendencies  are  frequently  observed  in  closed-loop  experimental  tests.  In 
practice,  a  driver  could  add  more  damping  to  the  system  by  extending  his/her  preview  time 
to  a  larger  value. 

In  Figures  5-15  and  5-16  the  same  maneuver  is  repeated  for  both  vehicles,  with  each  now 
modified  to  include  rear  wheel  steering  (k  =  0.75).  In  the  top  portion  of  Figure  5-15,  the 
front  wheel  steering  commands  calculated  by  the  driver  model  are  seen  for  each  vehicle, 
along  with  the  corresponding  rear  wheel  steering  values  (slaved  at  75%,  in  this  example,  of 
the  front  wheel  steer  commands).  The  calculated  vehicle  trajectories  are  seen  on  the  lower 
portion  of  the  figure.  Again,  as  in  Figure  5-13,  the  driver  model  manages  to  track  the 
desired  path  quite  accurately,  even  though  significantly  different  steering  control  inputs  are 
required  for  each  vehicle  by  the  driver  model.  The  use  of  rear  wheel  steering  is  seen  to 
increase  the  required  level  of  steering  fiwm  the  previous  example,  while  decreasing  the  peak 
amplitudes  of  vehicle  yaw  angle  and  lateral  acceleration  (Figure  5-16).  Both  driver-vehicle 
systems  also  exhibit  a  greater  degree  of  damping  when  rear  wheel  steering  is  present  This 
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-o— Passenger  Car  Loaded  HMMWV 

Front  Steer  Angle  -  deg 


Figure  5-13.  Driver  Model  Controlled  Lane-Change  Maneuver, 
front  wheel  only  steering;  k=  0 
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Figure  5-14.  Driver  Model  Controiled  Lane-Change  Maneuver, 
front  wheel  oniy  steering;  k=  0 
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Figure  5-15.  Driver  Model  Controlled  Lane-Change  Maneuver, 
front  and  rear  wheel  steering;  k  =  0.75 
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-0—0-  Passenger  Car  -Ar—A-  Loaded  HMMWV 


Lateral  Acceleration  eg  -  g's 


0  2  4  6  8 

Time  -  sec 

Figure  5-16.  Driver  Model  Controiled  Lane-Change  Maneuver, 
front  and  rear  wheel  steering;  k  =  0.75 
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observation  is  aiso  supported  by  recent  experimental  tests  of  four  wheel  steering  passenger 
cars  36,  37,  38,  39 

The  next  example  calculation,  seen  in  Figures  5-17  and  5-18  are  for  the  same  maneuver, 
but  the  two  vehicles  are  now  steered  by  means  of  an  applied  yaw  moment  control  torque. 
Neither  the  front  nor  the  rear  wheels  are  steered  in  this  example.  Lateral  motion  is  instead 
accomplished,  as  it  is  for  a  tracked  vehicle,  by  rotating  the  vehicle  in  yaw  through 
application  of  an  applied  moment  to  a  certain  sideslip  condition,  whereupon  the  non-steered 
wheels  (or  tracks)  generate  side  force  in  reponse  to  sideslip.  In  this  example,  it  is  assumed 
that  a  physical  mechanism  is  available  (such  as  differential  track  speeds)  which  can  generate 
an  applied  yaw  control  torque.  The  "control  coefficients"  in  the  previous  equations  then 
become:  A  =  0,  J?  =  0,  C  =  0,  and  D  =  1  with  the  control  variable,  uc,  now  interpreted  as 
torque,  instead  of  steer  angle. 

The  calculations  show  that  the  preview  model  is  quite  capable  of  steering  each  of  the 
example  vehicles  along  the  desired  trajectory  by  means  of  the  applied  control  torque.  Time 
histories  for  the  required  yaw  control  torques  for  each  vehicle  are  seen  in  the  upper  portion 
of  Figure  5-17  and  the  corresponding  trajectories  in  the  lower  portion  of  the  figure.  The 
difference  in  control  torque  magnitudes  is  due  to  the  difference  in  mass  and  dynamics  of  the 
two  vehicles.  The  results  seen  here  are  quite  similar  to  those  seen  earlier  in  Figures  5-13 
and  5-14  for  the  front  steer  only  example  calculations. 

The  final  example  calculation,  seen  in  Figures  5-19  and  5-20,  is  similar  to  the  previous  one 
but  employs  a  lateral  control  force,  instead  of  a  yaw  control  torque,  for  steering  each 
vehicle.  In  this  example,  the  control  force  is  applied  at  a  distance  of  2  feet  ahead  of  the 
mass  center  of  each  vehicle.  Consequently  the  "control  coefficients"  become:  A=0,B  = 
1,  C  =  0,  and  D  =  2.  Again,  the  control  force  magnitude  differences  seen  in  the  top 
portion  of  Figure  5-19  are  primarily  due  to  the  mass  and  inertia  differences  of  the  two 
vehicles  and  the  placement  of  the  control  force  relative  to  the  vehicle  mass  center.  Locating 
the  applied  control  force  further  ahead  of  the  vehicle  mass  center  scales  down  the  required 
control  force.  Placing  it  very  far  ahead  results  in  a  near  zero  applied  control  force 
accompanied  by  an  increased  yaw  moment,  thereby  approximating  the  previous  case  of 
control  by  means  of  an  applied  yaw  moment  only. 

If  the  control  force  is  applied  right  at  the  front  axle  position,  the  case  of  front  wheel  only 
steering  is  duplicated.  The  required  control  force  in  that  case  is  equal  to  the  product  of  the 
front  tire  cornering  stiffness  and  the  steering  angle  required  from  a  steerable  front  wheel. 

Regardless  of  the  particular  vehicle  control  mechanism  used,  the  above  examples 
demonstrate  that  as  long  as  the  preview  control  driver  model  has  a  simple  means  of 
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-a— □-  Passenger  Car 

Lateral  Acceleration  eg  -  g’s 


Figure  5-18.  Driver  Model  Controlled  Lane-Change  Maneuver, 
Steering  via  an  Appiied  Yaw  Control  Moment 


0  100  200  300  400  500  600 

X  Position  -  ft 

Figure  5-19.  Driver  Model  Controlled  Lane-Change  Maneuver, 
Steering  via  an  Applied  Lateral  Control  Force 
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-0—0-  Passenger  Car  -dr-^  Loaded  HMMWV 
Lateral  Acceleration  eg  -  g's 


Figure  5-20.  Driver  Model  Controlled  Lane-Change  Maneuver, 
Steering  via  an  Applied  Lateral  Control  Force 
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representing  the  dynamics  of  the  vehicle  and  its  control  mechanism  (via  an  internal  vehicle 
model),  it  is  capable  of  calculating  an  appropriate  control  variable  time  history  which  causes 
the  vehicle  to  follow  a  prescribed  path  —  and  do  so  in  a  manner  consistent  with  how  actual 
human  operators  would  steer  a  similar  vehicle.  To  underscore  this  latter  point,  the 
following  two  sections  of  the  report  will  present  test  data  collected  during  the  project,  as 
well  as  direct  comparisons  between  selected  examples  of  that  test  data  and  corresponding 
predictions  from  the  driver  model. 


5.6.  Driver  /  Vehicle  Tests 

Closed-loop  driver/vehicle  tests  were  conducted  during  the  project  at  the  Chrysler 
Corporation  Proving  Grounds  in  Chelsea,  Michigan.  The  primary  vehicle  used  in  these 
tests  was  an  M1057  Truck  also  known  as  the  HMMWV.  The  HMMWV  was  carrying  a 
3000  lb  payload  bringing  its  total  weight  to  7500  lb.  Figure  5-21  shows  a  sketch  of  the 
basic  HMMWV  used  in  these  tests.  The  30(X)  lb  payload  was  located  directly  over  the  rear 
axle  thereby  positioning  the  total  mass  center  (of  the  vehicle  and  payload)  at  a  point 
approximately  4  ft  ahead  of  the  rear  axle  and  4  ft  above  the  ground. 

A  short  sequence  of  additional  tests  were  conducted  with  the  same  HMMWV  pulling  an 
MlOl  trailer.  In  these  tests,  the  HMMWVs  weight  remained  at  7500  lb  and  the  total  trailer 
weight  was  3160  lb  (16(X)  lb  of  payload).  The  trailer  mass  center  was  slightly  ahead  of  its 
axle,  producing  a  vertical  hitch  load  of  176  lb  on  to  the  HMMWV.  Figure  5-22  shows  a 
sketch  of  the  MlOl  trailer. 

5.6.1.  Inertial  Parameter  Measurements.  The  HMMWV  was  weighed  in  its  test  condition 
(with  instrumentation  and  driver)  to  obtain  firont  and  rear  tire  loads  and  total  weight. 
Estimates  of  yaw,  pitch,  and  roll  inertias  were  estimated  or  obtained  from  previous  inertial 
measurements  of  the  same  vehicle  at  UMTRI.  Likewise,  total  center  of  gravity  height  was 
estimated  from  previous  empty  vehicle  inertial  measurements  and  the  known  payload 
location.  Measurements  of  wheelbase,  wheel  track,  suspension  locations,  and  overall 
geometry  were  also  performed.  Table  5-1  shows  the  parameter  measurements  and 
estimates  for  the  HMMWV  in  its  test  condition. 

5.6.2.  Tire  Measurements.  One  tire  (size:  36  x  12.50  -  16.5  LT)  from  the  HMMWV  test 
vehicle  was  tested  on  the  UMTRI  flat-bed  tire  test  machine  to  obtain  lateral  tire  force 
measurements  at  four  different  nominal  loads  (1000,  2000,  3000,  and  4(X)0  lb)  and  eight 
slip  angles  (-1,  0,  +1,  2,  3,  4,  6,  and  12  degrees).  See  Figures  5-23  and  5-24.  Tire 
cornering  stiffness  parameters  needed  by  the  driver  model  in  subsequent  model/test 
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Figure  5-21.  The  Ml  037  Truck  (HMMWV) 
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Table  5-1.  Parameter  Measurements  and  Estimates  for 
the  HMMWV  in  its  Test  Condition 


Totai  Weight 

7460 

lb 

Wheeibase 

130 

in 

Front  Axie  Load 

2920 

ib 

Rear  Axle  Load 

4540 

lb 

Distance  from  Total  c.g  Location 
to  Rear  Axie 

50.9 

in 

Totai  Yaw  Moment  of  Inertia 

70000 

in-lb-sec2 

Total  Pitch  Moment  of  Inertia 

60000 

in-lb-sec2 

Total  Roll  Moment  of  Inertia 

13200 

in-lb-sec2 

Front  Tire  Cornering  Stiffness 
(@  static  load) 

270 

Ib/deg 

Rear  Tire  Cornering  Stiffness 
(@  static  load) 

335 

Ib/deg 

Totai  c.g.  Height  Above  Ground 

48 

in 

60 


Figure  5-23.  HMMWVTire:  Muence  of  Tire  InHatior 
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HMMWV  Tire  @  20  psi 
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HMMWV  Tire  @  28  psi 
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Figure  5-24.  HMMWV  Lateral  Tire  Force  Measurements 
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validation  activities,  as  well  as  complete  lateral  tire  force  representation  within  the  DADS 
model  were  based  upon  these  measurements. 

5.6,3.  HMMWV  Test  Maneuvers.  Three  basic  sets  of  driver/vehicle  maneuvers  were 
conducted  during  the  test  program  with  the  HMMWV  test  vehicle.  (1)  The  first  test 
maneuver  was  simple  steady  turning  by  a  driver  along  a  circular  path .  The  purpose  of  this 
test  was  to  obtain  estimates  of  the  vehicle  understeer  and  basic  cornering  properties,  as  well 
as,  driver  closed-loop  steering  control  behavior  into  and  during  the  steady  turning 
maneuver  under  different  conditions.  (2)  The  second  maneuver  was  similar  to  the  first,  but 
braking  was  applied  diuing  the  turning  maneuver  by  the  driver  so  as  to  bring  the  vehicle  to 
a  stop  at  randomly  selected  points  along  the  curve.  (3)  The  third  type  of  maneuver  was  to 
drive  through  a  set  of  different  obstacle  courses,  as  defined  by  a  pattern  of  traffic  cones. 
These  tests  are  explained  more  fully  in  the  following. 

•  Driver-Controlled  Constant  Radius  Turning  Tests.  The  turning  tests 
were  conducted  at  25,  50,  and  60  mph  with  the  test  driver  attempting  to  track  a 
cone-marked  turn  of  fixed  radius  (500  ').  (A  radius  of  500  feet  produces  a  lateral 
acceleration  of  0,33  g's  at  50  mph  and  was  easily  accommodated  on  the  800'  x 
8(X)'  Chrysler  skid  pad  area.)  The  maneuver  was  begun  by  having  the  driver 
approach  the  circular  turn  along  a  straight  tangent  and,  then,  track  the  curve  at 
constant  speed.  See  Figure  5-25.  Transient  driver/vehicle  response  information 
due  to  entering  the  curve,  as  well  as  steady-state  driver/vehicle  response 
information  due  to  tracking  the  curve,  was  gathered  from  these  tests.  Influence  of 
forward  speed  and  lateral  acceleration  upon  system  damping  was  obtained  by 
conducting  the  same  tests  at  the  three  different  speeds.  Vehicle  turning  properties, 
such  as  understeer  level  and  steering  control  gains,  were  also  derived  from  the 
steady  turning  data  in  these  tests.  Further,  since  both  front  wheel  angles  and 
steering  wheel  angle  were  being  measured,  estimates  of  the  effective  steering  gear 
ratio  and  steering  system  compliance  properties  were  available  from  these  tests. 

•  Driver-Controlled  Braking-in-a-Tum  Tests.  The  braking-in-a-tum  tests 
were  all  conducted  from  an  initial  speed  of  50  mph  with  the  test  driver  attempting  to 
stop  the  vehicle  in  a  fixed  distance.  The  stopping  distances  were  varied  randomly, 
thereby  requiring  the  driver  to  achieve  different  deceleration  levels  during  each  stop. 
This  type  of  test  served  as  a  closed-loop  braking  control  task  for  the  driver,  while 
simultaneously,  yielding  information  on  the  basic  braking  performance  capabilities 
of  the  test  vehicle.  Wheel  lock-up  occurrences  were  recorded  for  the  shorter 
stopping  distance  cases.  The  driver  brake  pressure  responses  and  corresponding 
deceleration  time  histories  would  be  used  to  evaluate  and  outline  a  proposed  closed- 
loop  braking  algorithm  for  the  driver,  augmenting  the  driver  steering  control  model. 
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Figure  5-25.  Driver  Controlied  Constant  Radius  Turning  Test 


•  Obstacle  Course  Tests.  The  purpose  of  these  tests  was  to  gather  transient 
driver/vehicle  response  data  for  both  path-following  and  obstacle  avoidance 
maneuvers.  The  basic  type  of  maneuver  consisted  of  performing  various  lane-to- 
lane  movements  with  the  vehicle  as  it  traverses  a  cone-mariced  course.  Tests  were 
conducted  at  different  speeds  from  30  to  60  mph.  Three  basic  obstacle  course 
patterns  were  layed  out  and  are  shown  in  Figures  5-26  through  5-28: 

A)  Simple  Path-Constrained  Lane  Change  (Figure  5-26) 

B)  Simple  Unconstrained  Lane  Change  (Figure  5-27) 

C)  Obstacle  Course  (Figure  5-28) 


The  first  two  cases  were  included  primarily  to  evaluate  the  influence  of  path 
constraints  on  driver  steering  control  behavior.  The  constrained  lane  width  in  each 
of  these  tests  was  maintained  at  12  feet,  leaving  the  driver  with  about  2.5  feet  of 
lateral  maneuvering  space  with  the  vehicle  centered  in  the  lane.  The  remainder  of 
the  obstacle  course  tests  took  place  with  the  layout  shown  in  Figure  5-28.  In  these 
tests,  the  fore-aft  distances  between  the  12'  x  12'  square  obstacles  were  varied 
randomly  from  test  to  test 

In  the  lane-change  tests,  the  baseline  geometry,  with  the  shoot-to-shoot  forward 
travel  distance  (L)  set  at  100  feet,  produced  approximately  0.30  g's  of  peak  lateral 
acceleration  during  the  60  mph  maneuvers.  The  same  course  geometry  was  used 
for  the  30  mph  tests  in  order  to  evaluate  the  influence  of  forward  speed  upon  driver 
preview  and  system  dan:q)ing. 

In  the  obstacle  course  tests,  the  baseline  geometry  seen  in  Figure  5-29  produced 
peak  lateral  acceleration  levels  of  about  0.4  g's  with  the  obstacles  located  in  their 
normal  baseline  positions.  Tests  were  repeated  several  times,  with  the  distances 
LI,  L2,  and  L3  varied  in  a  random-like  sequence.  The  values  of  LI,  L2,  and  L3 
were  set  to  100  feet  in  the  baseline  course  geometry.  LI  and  L2  were  then  varied 
forward  or  rearward  by  20  feet  to  produce  a  'short'  or  'long'  variation  respectively 
from  the  nominal  baseline  geometry.  The  test  driver  continuously  drove  the  vehicle 
dynamics  oval  —  encountering  a  different  obstacle  course  layout  each  time  around 
the  track.  Data  collection  began  several  seconds  prior  to  the  beginning  of  the 
obstacle  course  and  ended  several  seconds  after  the  end  of  the  obstacle  course. 

Table  5-2  is  a  listing  of  the  log  sheets  from  the  test  program.  Run  numbers  and  speeds  are 

seen  in  the  first  two  columns.  Column  3  defines  the  test  maneuver.  Column  4  contains 
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L  adjusted  to  produce 
~  0.3  g  peak  lateral  accel. 


(not  to  scale) 


Change  Maneuver 
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O  Finish  0 


Figure  5-29.  Baseline  Obstacle  Course  Layout  Used  in  Tests 


69 


Table  5-2.  Log  Sheet  Summary  of  Driver- Vehicle  Tests 


Run  ffiSoeed 


VESMl 


Maneuver 


Comments 


Steady  Tumin 


28  Dsi  tire  oressures,  driver  #1 


Sion  of  Ay  chanqed  to  orooer  SAE  convention 


some  swervin 


5  moh  fast  at  end 


lost  velocity  signal  durino  run 


lost  yaw  rate  during  run 


Braking  in  a  Turn 


215'  stODDing  distance 


170  ' 


195' 


145' 


132' 


195' 


195' 


130',  left  rear  wheel  locked,  37'  of  skid 


140' 


130' 


125',  left  rear  wheel  locked,  34'  of  skid 


Constrained  Lane  Change 

12' 

X  100 

'  ,  28  psi  tire  pressures 

lost  velocity  signal  at  end  of  run 
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Table  5-2.  Log  Sheet  Summary  of  Driver-Vehicle  Tests  (continued) 


Run  MSoeed 


lUulsUil 


Maneuver 


Comments 


Constrained  Lane  Change 


nconstrained  Lane-Chan 


driver  #2 


driver  #2 


driver  #2 


driver  #2 


driver  #2 


12'  X  100',  driver  #1,  no  cones  hit 


Temoorarv  Obst  Course 


driver  #2,  hit  numerous  cones 


driver  #2.  no  cones  hit 


driver  #1 


Obstacle  Course 


Obstacle  Course 


see  Fig  5.6-6,  driver  #1 ,  center/center 


center/center,  hit  obstacle  #2  on  right 


center/short 


center/Ion 


center/Ion 


center/short 


center/center 


short/center 


iong/short,  hit  second  obstacle 


long/center 


obst  #2  width=9.5' 


obst  #2  width=9.5’ 


long/Ion 


center/short 


short/short.  cliDoed  obst  #2 


center/center 


long/center,  clipped  obst  #2 


Iong/short.  hit  obst  #2 
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Table  5-2.  Log  Sheet  Summary  of  Driver-VehiclQ  Tests  (continued) 
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Table  5-2.  Log  Sheet  Summary  of  Driver- Vehicle  Tests  (continued) 
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Table  5-2.  Log  Sheet  Summary  of  Driver- Vehide  Tests  (continued) 
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Table  5-2.  Log  Sheet  Summary  of  Driver- Vehicle  Tests  (continued) 
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Table  5-2.  Log  Sheet  Summary  of  Driver- Vehicle  Tests  (continued) 
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additional  comments  specific  to  each  test  Two  additional  test  maneuvers  for  the  HMMWV 
are  listed  in  the  log  sheets  of  Table  5-2  as  "Random  Steer  Tests"  and  "Straight-line 
Braking".  These  tests  were  conducted  initially  as  "additional"  tests  to  provide  further  data 
on  the  directional  dynamics  and  braking  characteristics  of  the  HMMWV.  It  turned  out  that 
the  information  provided  by  these  additional  tests  was  not  subsequently  needed  in  the 
model  validation.  However,  the  data  from  these  additional  tests  are  available  as  part  of  the 
entire  collection  of  test  data  being  delivered  to  TACOM  and  can  be  used  as  a  source  of 
additional  information.  The  "Straight-line  Braking"  tests  were  conducted  in  the  same 
manner  as  the  braking-in-a-tum  baseline  tests  (but  without  any  turning)  with  the  stopping 
point  varied  in  a  random  manner.  The  stopping  distances  are  noted  in  the  log  sheets  of 
Table  5-2.  The  "Random  Steer"  tests  were  conducted  during  straight-line  driving  with  the 
test  driver  producing  a  random-like  steering  input  to  purposely  excite  the  vehicle  directional 
dynamics  across  a  range  of  steering  input  frequencies.  Fourier  transforms  can  be 
performed  on  these  measured  vehicle  responses  and  the  steering  input  to  obtain  frequency 
response  characteristics  for  the  open-loop  directional  dynamics  of  the  vehicle. 

Example  measurements  from  each  of  these  basic  test  maneuvers  appear  in  Appendix  B. 
The  total  set  of  data  collected  during  the  test  program  are  being  delivered  to  TACOM  on 
floppy  disks  in  a  standardized  UMTRI  format 

5.6.4.  Data  Acquisition  Equipment  Test  data  was  collected  using  the  UMTRI  portable 
data  acquisition  system.  The  system  consists  of  a  Texas  Instruments  TM  990 
microprocessor,  signal-conditioning  units,  programmable  filters,  and  analog/digital 
converters.  A  CRT  unit  and  keyboard  were  used  to  operate  and  control  the  system.  Data 
were  stored  on  high  capacity  digital  tape  cartridges  for  subsequent  post-processing.  Simple 
statistical  calculations  and  background  calibrations  could  be  performed  in  the  field.  Spot 
checks  of  the  collected  data  would  occur  periodically  throughout  the  duration  of  the  test 
program  to  guard  against  undetected  instmmentation  failures.  All  of  the  test  data  collected 
during  the  program  were  transferred  to  hard  disks  and  floppies  in  an  UMTRI  standard 
format  for  subsequent  plotting  and  analysis. 

5.6.5.  Vehicle  /  Driver  Measurements.  The  vehicle  was  instrumented  with  appropriate 
transducers  and  the  UMTRI  data  acquisition  package  to  measure  the  following  signals  and 
vehicle  responses: 

•  Lateral  Acceleration 

•  Longitudinal  Acceleration 

•  Vehicle  Velocity 
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•  Yaw  Rate 


•  Roll  Angle 

•  Front  Wheel  Steer  Angles  Geft  and  right) 

•  Steering  Wheel  Angle 

•  Brake  Pedal  Pressure 

The  UMTRI  stable  platform  was  used  to  measiu-e  the  vehicle  lateral  and  longitudinal 
accelerations,  as  well  as  the  yaw  rate  and  roll  angle,  relative  to  a  horizontal  plane  oriented 
normal  to  the  gravity  vector.  A  conventional  fifth  wheel  was  used  to  measure  forward 
velocity.  Front  wheel  angles  were  measured  with  linear  potentiometers,  driver  steering 
wheel  angle  with  a  rotary  potentiometer,  and  driver  brake  pedal  force  with  a  hydraulic 
pressure  transducer. 

5.6.6.  Special  HMMWV-Trailer  Tests.  A  sequence  of  baseline  articulated  vehicle  tests 
were  also  conducted  using  the  single-axle  MlOl  trailer  attached  to  the  HMMWV  via  its  rear 
pintle-hook.  The  trailer  load  was  located  approximately  over  the  trailer  axle,  producing  a 
vertical  hitch  load  of  176  lbs  at  the  HMMWV  pintle  hook.  The  dynamics  of  the  trailer,  and 
its  possible  effect  upon  driver  steering  control  activity,  were  evaluated  during  a  repeat  of 
several  of  the  lane-change  and  circular  turning  tests.  Using  the  test  data  collected  under  this 
project,  Mousseau  in  a  TACOM  technical  report,'^  ^  fully  analyzed  the  HMMWV-trailer 
combination  vehicle  using  the  DADS  simulation.'^ 

In  addition  to  the  baseline  tests  studied  by  Mousseau,  a  short  series  of  straight-line  stability 
tests  were  also  conducted  with  the  trailer  payload  located  in  an  adverse  rearward  location, 
thereby  exciting  a  limit-cycle  response  in  the  articulation  motion.  The  resulting  driver 
steering  action  in  response  to  the  limit  cycle  motion  was  later  analyzed  and  compared  with 
results  from  comparable  simulation  runs.  A  short  technical  paper  reporting  on  some  of 
these  special  tests  appears  in  Appendix  G  of  this  report. 

Example  measurements  from  the  HMMWV-Trailer  test  program  appear  in  Appendix  C.  As 
in  the  case  of  the  HMMWV  data,  all  the  trailer  test  results  are  being  delivered  to  TACOM 
on  floppy  disks  in  a  standardized  format. 

During  all  of  these  tests,  the  MlOl  trailer  was  instrumented  with  three  additional 
transducers  to  measure  the  following  vehicle  responses: 

•  Trailer  Lateral  Acceleration 
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•  HMMWV-Trailer  Articulation  Angle 
and 

•  Trailer  Roll  Angle 

The  last  portion  of  Table  5-2  lists  the  HMMWV-trailer  tests.  Tests  271-310  correspond  to 
the  HMMWV-trailer  in  its  normal  loading  state  as  reported  on  by  Mousseau.^^  Tests  336- 
348  ("Oscillation  Tests")  correspond  to  the  straight-line  stability  tests  with  the  trailer  loaded 
in  an  adverse  rearward  manner  in  order  to  excite  the  limit  cycle  trailer  oscillations.  Tests 
320-335  ("Divergence  Tests")  had  the  trailer  payload  located  in  the  far  forward  position, 
but  produced  no  significant  instability  or  difficulty  for  the  driver.  A  video  tape  was  also 
produced  at  the  time  of  these  tests  to  record  several  of  the  trailer  oscillation  responses  for 
later  analysis. 


5.7.  Driver  Model  Validation 

The  material  presented  in  this  section  of  the  report  validates  the  developed  steering  control 
model  by  comparing  example  test  results  directly  with  corresponding  predictions  from  the 
model.  In  most  of  these  comparisons,  the  driver  model  is  used  in  conjunction  with  a  linear 
vehicle  model.^^  In  cases  involving  significant  nonlinearities,  fully  nonlinear  vehicle 
models  are  used  with  the  same  driver  model  to  represent  the  vehicle.  The  parameters 
selected  for  the  vehicle  model  were  based  upon  the  measured  and  estimated  values  obtained 
during  the  course  of  the  project  as  reported  in  the  previous  section  and  by  Mousseau.^^ 
Table  5-3  lists  the  basic  vehicle  and  driver  parameters  used  in  most  of  these  validation 
calculations.  Any  changes  in  speed,  tire  properties,  or  driver  parameters  for  the  individual 
comparisons  that  follow  are  noted  and  explained  in  the  corresponding  discussions  for  each 
case. 

The  first  series  of  tests  examined  are  for  the  constrained  lane-change  maneuver  at  the 
nominal  speed  of  60  mph.  Figures  5-30  and  5-31  show  a  comparison  between 
experimental  measurements  and  predictions  from  the  TACOM  driver  model.  Tests  126, 
127,  129,  and  130  represent  four  repeated  runs  by  the  test  driver  through  the  constrained 
lane-change  test  course  seen  in  Rgure  5-26  at  60  mph.  The  driver  steering  wheel  angle  and 
lateral  acceleration  signals  seen  in  these  two  figures  are  direct  measurements.  The 
experimental  lateral  displacement  and  yaw  angle  signals  are  obtained  from  the  measured 
data  by  doubly  integrating  the  lateral  acceleration  and  singly  integrating  the  yaw  rate 
measurements  respectively  over  the  time  interval  shown.  The  thick  dark  line  represents  the 
output  from  the  model  using  an  identical  12-ft  by  100-ft  lane-change  course  as  that  used  in 
the  tests  for  its  desired  path  input  Preview  time  and  driver  lag  values  were  selected  as  1.1 
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Table  5-3.  Baseline  Driver/Vehicie  Parameters  Used  in 
Validation  Calculations 


Driver  Model  Preview  Time 

1.1 

sec 

Driver  Model  Delay  Time 

0.1 

sec 

Total  Vehicle  Weight 

7500 

lb 

Wheelbase 

130 

in 

Front  Axle  Load 

2932 

lb 

Rear  Axle  Load 

4568 

lb 

Distance  from  Total  c.g  Location 
to  Rear  Axle 

50.8 

in 

Total  Yaw  Moment  of  Inertia 

70000 

in-lb-sec2 

Total  Pitch  Moment  of  Inertia 

60000 

in-lb-sec2 

Total  Roll  Moment  of  Inertia 

13200 

in-ib-sec2 

Front  Tire  Cornering  Stiffness 
(@  static  load) 

270 

Ib/deg 

Rear  Tire  Cornering  Stiffness 
(@  static  load) 

335 

Ib/deg 

Total  c.g.  Height  Above  Ground 

48 

in 
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0  2  4  6  8 

time  -  sec 


Figure  5-30.  Driver  Model  Validation,  Constrained  Lane-Change 
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0  2  4  6  8 

time  -  sec 


0  2  4  6  8 

time  -  sec 


Figure  5-31 .  Driver  Model  Validation,  Constrained  Lane-Change 


seconds  and  0.1  seconds  respectively  to  provide  the  degree  of  matching  observed  in 
Figures  5-30  and  5-31. 

The  relatively  small  value  of  the  driver  time  delay  parameter  (0.1  seconds)  is  an  interesting 
result  Recall  from  section  5.3  that  most  previous  research  involving  random  excitation  of 
driver  vehicle  systems  suggests  that  the  TACOM  driver  model  can  best  match  such  data  by 
using  a  value  of  approximately  0.25  seconds  (1/coc,  or,  1/4  rad/sec)  for  this  parameter. 
However,  these  results  are  based  upon  closed-loop  tests  involving  passenger  cars.  One 
explanation  of  this  apparent  conflict  may  be  that  because  the  HMMWV  is  more  sluggish  in 
its  directional  dynamics  than  a  conventional  passenger  car,  the  driver  of  a  HMMWV  is 
required  to  provide  more  lead  time  and  anticipation  in  order  to  perform  a  comparable 
maneuver.  Another  explanation  may  be  that  the  lane-change  tests  conducted  here  were 
highly  repeatable  and  easily  predicted  by  the  driver.  Consequently,  the  "processing  time" 
required  by  the  driver  to  obtain  an  appropriate  steering  input  for  these  tests  may  be 
considerably  less  than  if  the  path  input  was  less  predictable.  A  reduction  in  driver 
processing  time  would  then  be  reflected  in  the  driver  model  by  a  smaller  value  of  the  driver 
time  lag  parameter.  However,  a  previous  study  ^  which  examined  lane-change  tests 
with  drivere  of  passenger  cars  and  then  represented  the  results  with  a  similar  version  of  the 
TACOM  model,  concluded  that  values  of  0.2  to  0.3  seconds  were  appropriate  in 
representing  driver  steering  control  time  delay  characteristics  for  that  vehicle  in  a  nearly 
identical  lane-change  maneuver.  This  would  then  seem  to  suggest  that  the  differences 
raised  here  in  driver  time  delay  characteristics  are  somehow  related  to  the  directional 
dynamics  of  the  controlled  vehicle. 

To  illustrate  this  point  further  by  example,  if  a  driver  model  time  lag  value  of  0.25  seconds 
is  used  instead  of  the  0.1  second  value  for  the  same  HMMWV  calculation  just  presented, 
the  preview  time  parameter  must  ccarespondingly  be  increased  to  maintain  the  same  degree 
of  damping  shown  in  the  test  data.  This  then  results  in  a  somewhat  more  sluggish 
response  fix)m  the  model  with  most  of  the  resulting  waveforms  having  a  longer  period  than 
that  seen  in  the  test  data.  Figures  5-13  and  5-14,  for  example,  previously  showed  a 
calculation  for  the  HMMWV  using  a  larger  set  of  time  delay  and  preview  time  parameters. 
The  result  was  a  considerably  more  sluggish  response  than  that  seen  in  Figures  5-30  and  5- 
31. 

The  suggestion  that  the  TACOM  driver  model  time  delay  parameter  should  be  reduced  in 
certain  cases  to  values  less  than  those  previously  suggested  by  random  disturbance  tests 
24,  25,  26  jg  important  result.  This  finding  may  suggest  that  drivers  of  land  vehicles 
having  more  sluggish  directional  dynamics  are  required  to  be  more  responsive  during 
typical  steering  maneuvers  in  order  to  compensate  for  the  increased  lag  of  the  vehicle. 
Intuitively,  this  makes  sense,  but  heretofore,  this  observation  about  the  responsiveness  of 
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drivers  and  the  directional  responsiveness  of  vehicles  has  not  been  adequately  established 
and  linked  to  experimental  evidence  from  full-scale  tests  of  diiverA^ehicle  systems. 

A  less  obvious  suggestion  that  driver/vehicle  systems  are  not  necessarily  any  more  stable 
with  shortened  driver  lags  follows  from  the  observation  that  the  preview  time  is  apparently 
reduced  "in  step"  with  the  driver  lag  for  the  lane-change  data  collected  here.  (Ordinarily, 
experimental  measurements  obtained  from  random  disturbance  tests  of  passenger  car  / 
driver  systems  would  suggest  values  of  the  time  delay  parameter  on  the  order  of  0.25 
seconds,  and  values  of  the  preview  time  on  the  order  of  L5  to  3.0  seconds.^)  Recall  that 
reductions  in  stability  occur  in  the  model  for  either  an  increased  driver  time  lag  or  a  reduced 
driver  preview  time.  Consequently,  similar  stability  margins  can  be  maintained  in  the 
model  to  some  extent  by  compensating  increases  in  one  parameter  with  increases  in  the 
other  parameter.  Any  such  apparent  "correlation"  between  driver  time  delay  and  preview 
time  thereby  allows  the  driver  to  maintain  approximately  the  same  level  of  closed-loop 
system  stability  as  a  corresponding,  but  less  responsive,  driver/yehicle  system  having  a 
larger  time  delay  and  longer  preview  time.  It  may  be  that  drivers,  under  tight  maneuvering 
conditions,  only  look  far  enough  ahead  to  negotiate  the  next  immediate  "obstacle,"  thereby 
requiring  a  shortening  of  their  preview  time  during  such  maneuvers.  In  order  to  maintain  a 
desired  level  of  stability,  drivers  may  then  decrease  their  time  delay  cycle  through  faster 
information  processing  under  such  circumstances. 

Along  this  line,  MacAdam  in  1983  hypothesized  that  drivers  could  possibly  "trade  off 
directional  stability  for  improved  path  tracking  capabilities.  This  work  however  assumed 
that  the  driver  time  delay  parameter  (e.g.  0.25  seconds)  was  largely  invariant  based  upon 
the  measurements  of  the  previous  research  using  random  disturbance  input  testing.  The 
findings  reported  here,  however,  seem  to  suggest  instead,  that  depending  upon  the  vehicle 
being  controlled,  drivers  have  more  control  over  their  time  delay  characteristics  than 
previously  observed,  and,  that  no  such  "trade  off  between  directional  stability  and  path 
tracking  performance  need  necessarily  occur. 

To  further  support  the  observation  linking  reduced  driver  time  lag  characteristics  and  the 
HMMWV  test  vehicle,  the  unconstrained  lane-change  maneuvers  also  conducted  during 
this  testing  clearly  demonstrated  that  both  test  drivers  (during  the  sequence  of  lane-change 
tests  125  through  153;  constrained  and  unconstrained)  exhibited  even  more  responsive 
behavior  when  the  lane-change  course  was  unconstrained  than  when  the  course  was 
constrained.  The  basic  observation  was  that  the  test  drivers  acted  with  more  of  an  "open- 
loop"  steering  manner  in  initiating  the  unconstrained  lane-change  maneuver,  moving 
qiuckly  from  the  initial  lane  to  the  second  lane.  This  was  then  followed  by  a  more  apparent 
"closed-loop"  steering  control  pattern  to  stabilize  the  vehicle  in  the  second  lane.  To 
illustrate  this  point.  Figure  5-32  shows  a  comparison  of  steering  and  lateral  displacement 
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Figure  5-32.  Constrained  vs.  Unconstrained  Lane-Change  Test 
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Lateral  Acceleration  -  g's 


time  -  sec 


Test  ID  126,  constrained  A-  Test  ID  149,  unconstrained 
Heading  Angle  -  deg 


time  -  sec 

Figure  5-33.  Constrained  vs.  Unconstrained  Lane-Change  Test 
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time  histories  for  test  126  (constrained)  and  test  149  (unconstrained).  Note  the  more 
responsive  and  aggressive  behavior  exhibited  during  the  unconstrained  test.  This  appeared 
to  be  a  typical  trend  for  most  of  the  constrained  vs.  unconstrained  comparisons.  Figure  5- 
33  shows  corresponding  lateral  acceleration  and  yaw  angle  comparisons  from  the  same  two 
tests.  Again,  the  unconstrained  response  is  more  rapid,  particularly  during  the  reversal  and 
correction  phase  of  the  maneuver.  It  was  also  visually  apparent  to  observers  at  the  time  of 
these  experiments  that  the  test  drivers  were  performing  the  unconstrained  lane-changes 
more  quickly  and  aggressively. 

This  observed  behavior  pattern  during  the  unconstrained  lane-change  maneuvers  seems  to 
raise  the  question  for  users  of  the  driver  model  as  to  what  an  "appropriate"  desired  path 
input  should  be  in  cases  where  portions  of  the  desired  trajectory  are  ill-defined.  In  the  case 
of  the  constrained  lane-change  maneuver,  the  12-ft  x  100-ft  trajectory  is  quite  obvious  since 
it  represents  the  centerline  of  the  constrained  course.  However,  when  the  middle  of  the 
course  is  opened  up,  as  in  the  unconstrained  case,  a  corresponding  desired  path  is  not  as 
obvious.  Based  on  the  above  test  results  though,  it  appears  that  a  more  rapid  lane-change 
path  input  is  appropriate  in  such  cases,  for  example,  a  12-ft  x  75-ft,  or  possibly,  a  12-ft  x 
50-ft  trajectory.  In  any  event,  a  "bandwidth  limit"  for  the  driver-vehicle  system  will 
eventually  be  reached  as  the  trajectory  approaches  a  step-like  input  with  the  corresponding 
driver- vehicle  reponse  representing  the  bound  for  the  system.  Ordinarily,  matching  of  the 
model  with  such  data  can  be  accommodated  by  selecting  appropriate  path  inputs  in 
combination  with  a  representative  set  of  driver  time  lag  and  preview  time  parameters.  In 
the  unconstrained  example  just  seen,  a  12-ft  x  50-ft  trajectory  would  better  permit  the 
model  to  reproduce  the  responses  observed  in  the  test  data. 

The  next  example  of  validating  the  driver  model  predictions  is  presented  in  Figures  5-34 
and  5-35  for  the  baseline  obstacle  course  maneuver  of  Figme  5-29.  In  this  maneuver,  the 
vehicle  speed  is  maintained  at  40  mph  as  the  driver  steers  the  vehicle  from  the  left  lane  to 
the  right  lane  around  the  first  obstacle.  The  vehicle  is  then  steered  back  to  the  left,  around 
the  second  obstacle,  and  then  to  the  right  lane  again  to  exit  the  course  (positive  values  of 
lateral  displacement  in  Figure  5-34  are  to  the  right  on  the  test  course).  In  this  example 
comparison,  runs  for  the  "center/center"  positioning  of  the  obstacles  were  selected  (test 
numbers  168,  178,  182,  and  183  fi’om  the  log  sheets  of  Table  5-2).  The  "center/center" 
obstacle  arrangement  had  equal  longitudinal  gaps  of  100  ft  between  each  of  the  obstacles, 
as  well  as  at  the  entrance  and  exit  portions  of  the  course  (i.e.,  LI  =  L2  =  L3  =  100'  in 
Figure  5-28).  Figures  5-34  and  5-35  show  an  overlay  of  the  four  "center/center"  tests  and 
the  predicted  response  firom  the  driver  model.  Also  seen  in  the  trajectory  overlay  portion  of 
Figure  5-34  are  the  locations  of  the  two  obstacles. 
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Figure  5-34.  Driver  Model  Validation,  Obstacle  Course,  40  mph 
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Figure  5-35.  Driver  Model  Vaiidation,  Obstacle  Course,  40  mph 
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Unlike  the  previous  lane-change  tests  in  which  the  course  geometry  remained  static,  the 
geometry  of  the  obstacle  course  was  varied  to  some  extent  from  test  to  test  by  random 
longitudinal  placement  of  the  two  obstacles.  The  exact  placement  of  the  obstacles  was 
unknown  to  the  test  driver  until  the  vehicle  entered  the  obstacle  course.  Despite  this,  the 
test  driver  was  still  able  to  replicate  with  some  accuracy  the  same  basic  response  during 
each  of  the  tests  seen  in  Figures  5-34  and  5-35. 

The  driver  model  preview  time  and  time  delay  parameters  used  for  the  obstacle  course 
validation  calculations  were  the  same  values  used  in  the  previous  lane-change  validation 
(1.1  and  0.1  seconds  respectively).  The  desired  path  used  as  the  input  to  the  driver  model 
was  simply  taken  as  the  "center-line"  of  the  course  and  defined  here  as  seven  straight-line 
segments: 


X  y 


0.0 

0.0 

< —  175'  straight-line  to  entrance  of  course 

175.0 

0.0 

< —  entrance  point  of  course 

275.0 

12.0 

< —  100' gap  to  first  obstacle 

287.0 

12.0 

< —  12'  width  of  first  obstacle 

387.0 

0.0 

< —  100'  gap  to  second  obstacle 

399.0 

0.0 

< —  12'  width  of  second  obstacle 

499.0 

12.0 

< —  100'  gap  to  exit  of  course 

999.0 

12.0 

< —  strai^t-line  exit  out  of  course 

As  seen  in  these  figures,  the  model  predictions  are  in  very  good  agreement  with  the 
measured  responses.  Again,  as  in  the  previous  comparison,  the  lateral  displacement  and 
yaw  angle  measurements  were  obtained  from  integration  of  the  lateral  acceleration  and  yaw 
rate  measurements  over  the  length  of  the  course.  The  longitudinal  displacement  signal 
(Figure  5-34)  was  obtained  by  integration  of  the  fifth-wheel  forward  speed  measurement 

In  the  "Comments"  field  of  the  log  sheets  (Table  5-2)  for  run  #182,  it  is  noted  that  obstacle 
#2  was  "clipped"  during  this  test  This  can  be  seen  as  well  in  the  test  data  of  Figure  5-34  in 
which  one  of  the  test  trajectories  (from  run  #182)  records  a  value  of  lateral  displacement  of 
about  3.5-ft  at  the  390-ft  mark  of  longitudinal  displacement.  Since  the  half-width  of  the 
UMMWV  is  about  3.25-ft  at  the  outside  of  the  tires  and  an  indicated  clearance  of  only  2.5 
is  seen  at  the  point  shown,  this  particular  trajectory  would  produce  wheel  or  body  contact 
with  obstacle  #2. 

Finally,  a  sequence  of  frames  from  a  simplified  computer  animation  program  is  shown  in 
Figures  5-36  through  5-39  to  illustrate  the  response  and  trajectory  of  the  vehicle  during  the 
obstacle  course  maneuver.  The  frame  number  and  time  (corresponding  to  that  in  Figures  5- 
34  and  5-35)  are  noted  in  the  upper  left  comer  of  each  frame.  The  location  and  orientation 
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Figure  5-36.  HMMWV  Entering  the  Obstacle  Course 
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Figure  5-38.  HMMWV  Negotiating  the  Second  Obstacle 
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Figure  5-39.  HMMWV  Exiting  the  Obstacle  Course 
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of  the  vehicle  at  each  of  the  animation  positions  can  be  coordinated  with  the  time  histories 
of  Figures  5-34  and  5-35  through  the  time  parameter  shown  in  each  frame.  The  observer 
during  this  animation  sequence  is  at  a  forward  position  of  400  ft,  a  lateral  position  of  200 
ft,  and  an  elevation  of  100  ft 

The  next  maneuver  examined  during  the  validation  exercise  is  that  of  steady  turning  (to  the 
left)  along  a  circular  arc  of  5(X)  ft  radius.  As  noted  in  section  5.6,  tests  were  conducted  at 
different  speeds  and  tire  inflation  pressures  in  order  to  study  the  response  of  the 
driver/vehicle  system  under  different  lateral  acceleration  conditions  and  for  different  sets  of 
vehicle  directional  dynamics.  A  sequence  of  figures  is  presented  in  the  following 
discussion  which  compares  the  predicted  response  of  the  TACOM  driver  model  and 
simulated  vehicle  with  corresponding  measurements  from  a  number  of  steady  turning  tests. 

The  first  comparison,  shown  in  Figures  5-40  and  5-41,  is  for  a  low  speed  (24.5  mph),  low 
lateral  acceleration  operating  condition.  Figure  5-40  shows  the  steering  wheel  angle  input 
from  the  driver  and  the  left  front  wheel  angle  at  the  road.  Figure  5-41  shows  the 
corresponding  lateral  acceleration  and  yaw  rate  relative  to  a  stable  platform  oriented  normal 
to  the  gravity  vector.  The  HMMWV  was  loaded  as  before  in  its  baseline  configuration  with 
all  tires  inflated  to  28  psi.  Measured  signals  from  tests  219,  220,  and  221  are  shown 
overlayed  with  the  prediction  from  the  TACOM  driver  model.  The  same  linear  vehicle 
model  was  used  to  represent  the  HMMWV  dynamics.  As  seen  in  these  two  figures,  the 
three  test  results  and  the  model  predictions  are  in  close  agreement.  Since,  the  vehicle  is 
turning  on  a  circular  arc  and  at  low  lateral  acceleration,  the  front  wheel  angles  should  be 
close  to  the  Ackerman  steer  angle,  L/R,  equal  here  to  (130/12)  /  (5(X))  •  57.3  degrees,  or, 
1.24  degrees.  The  test  data  and  the  model  both  indicate  measured  values  in  that  range.  The 
measured  and  predicted  values  are  slightly  smaller  than  the  Ackerman  value  due  to  the 
modest  oversteer  condition  of  the  vehicle  and  the  0.08  g’s  of  lateral  acceleration  present 
during  the  test 

The  next  comparison  is  for  the  driver/vehicle  system  performing  the  same  maneuver  at  a 
higher  speed  and  lateral  acceleration  condition.  Figmes  5-42  and  5-43  show  the  same  four 
driver/vehicle  responses  compared  for  the  driver  model  and  tests  223  and  224.  The  speed 
was  maintained  at  an  approximately  constant  value  of  49  mph  during  these  tests.  Again, 
the  basic  predicted  and  measured  responses  are  in  good  agreement.  Note  that  despite  the 
increase  in  lateral  acceleration  level  for  this  maneuver,  the  driver  input  at  the  steering  wheel 
is  about  the  same.  This  is  a  direct  result  of  the  steering  system  compliance.  The  vehicle, 
with  respect  to  the  steering  wheel  input,  could  then  be  considered  to  be  approximately 
neutral  steer  with  the  steering  system  compliance  contributing  about  2  deg/g  of  understeer, 
thereby  cancelling  out  the  opposite  buy  equal  oversteer  condition  of  the  vehicle  at  the  road 
wheels.  Since  the  road  wheel  steer  angle  requirement  decreased  by  approximately  0.5 
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Figure  5-40.  Driver  Modei  Validation,  500'  Radius,  24.5  mph 
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Figure  5-41 .  Driver  Model  Validation,  500'  Radius,  24.5  mph 
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Figure  5-42.  Driver  Model  Validation,  500'  Radius,  49  mph 
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Figure  5-43.  Driver  Modei  Validation,  500'  Radius,  49  mph 
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degrees  when  going  from  0.08  g's  of  lateral  acceleration  to  0,32  g's  of  lateral  acceleration 
along  the  same  turn  radius,  the  observed  oversteer  level  of  the  vehicle  is  0.5  /  (0.32  -  0.08) 
or  about  2  deg/g  with  respect  to  the  road  wheels. 

A  final  set  of  steady  turn  tests  were  conducted  with  reduced  tire  inflation  pressures  and  at 
elevated  speeds  in  order  to  produce  an  unstable  set  of  directional  vehicle  dynamics  for  the 
driver  to  contend  with  during  the  steady  turning  maneuver.  The  idea  was  to  introduce  an 
increased  level  of  oversteer  into  the  directional  dynamics  through  controlled  reductions  in 
tire  inflation  pressures.  The  vehicle  would  then  be  steered  along  the  same  circular  turn  at 
incremented  speeds  and  corresponding  lateral  acceleration  conditions.  Provided  that  3  to  4 
degrees  of  oversteer  could  be  introduced  by  appropriate  selection  of  front  and  rear  tire 
inflation  pressures,  a  critical  velocity  in  the  vicinity  of  50  mph  could  be  obtained  at  which 
point  the  directional  dynamics  of  the  vehicle  become  unstable.  This  would  then  produce  a 
requirement  on  the  part  of  the  test  driver  to  stabilize  the  vehicle  by  appropriate  steering 
control  actions  which  would  be  measured  and  recorded  for  subsequent  analysis.  The  next 
two  sets  of  figures  show  example  results  from  this  experimental  approach. 

Based  upon  the  tire  data  shown  in  Figure  5-23,  reduced  tire  pressures  will  affect  the 
relative  firont  and  rear  tire  cornering  stiffnesses,  thereby  altering  the  directional  dynamics  of 
the  vehicle  through  a  change  in  understeer  level.  Referring  to  Figures  5-44  and  5-45, 
simulated  and  measured  responses  are  shown  for  the  condition  of  reduced  tire  pressures 
and  an  average  test  speed  of  47  mph.  When  compared  with  the  previous  28  psi,  49  mph, 
steady  turn  maneuver,  the  results  do  not  look  extremely  different.  This  is  apparently  a 
result  of  nearly  proportional  reductions  occurring  in  the  front  and  rear  tire  cornering 
stiffnesses,  thereby  causing  little  net  change  in  the  oversteer  condition  of  the  vehicle.  Tire 
heating  was  also  occurring  during  this  sequence  of  tests  causing  the  tire  inflation  pressures 
to  rise  to  approximately  24-26  psi,  offsetting  somewhat  the  anticipated  increase  in 
oversteer.  Further  alteration  of  tire  inflation  pressures  were  made  at  this  point  in  the  testing 
to  provide  a  stronger  front/rear  bias  in  tire  properties,  and  in  turn,  a  correspondingly 
increased  oversteer  condition  of  the  vehicle. 

As  speeds  were  increased  to  nearly  60  mph  with  additional  side-to-side  load  transfer  also 
contributing  to  a  greater  oversteer  condition,  unusual  driver  steering  control  waveforms 
characterized  by  long  period  oscillations  were  recorded  in  several  of  the  tests.  At  the  same 
time,  the  tire  inflation  pressures  were  gradually  increasing  again  due  to  further  heating  of 
the  tires.  In  test  253,  the  rear  tire  pressures  were  set  back  to  22  psi  in  order  to  maintain  an 
elevated  oversteer  condition  of  the  vehicle  and  the  nominal  60  mph  test  was  repeated.  The 
result  from  this  test,  similar  to  some  of  the  previous  60  mph  tests,  is  shown  in  Figures  5- 
46  and  5-47.  The  unusual  long  period  steering  waveform  produced  by  the  driver  is  a  result 
of  controlling  the  vehicle  above  its  critical  velocity  and  during  which  the  directional 
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Figure  5-44.  Driver  Model  Validation,  500'  Radius,  47  mph 
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Lateral  Acceleration  -  g’s  Tires  @  22  psi 


Figure  5-45.  Driver  Model  Validation,  500'  Radius,  47  mph 
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Figure  5-46.  Driver  Model  Validation,  500'  Radius,  57  mph 


Lateral  Acceleration  -  g's 
.1  1 - 


0 


Yaw  Rate  -  deg/sec 


Figure  5-47.  Driver  Model  Validation,  500'  Radius,  57  mph 


dynamics  are  unstable.  Obvious  counter-steering  at  the  front  wheels  can  be  seen  in  the 
lower  portion  Figure  5-46,  where  the  left-turning  vehicle  is  being  steered  by  means  of  an 
average  front  wheel  angle  which  is  positive,  or,  steered  to  the  right.  The  average  driver 
input  at  the  steering  wheel  is  slighdy  negative,  or  to  ther  left,  due  to  the  compliance  in  the 
steering  system.  The  actual  average  speed  recorded  during  this  test  was  57  mph. 

Also  seen  in  Figures  5-46  and  5-47  is  a  prediction  from  the  TACOM  driver  model.  In 
order  to  obtain  the  degree  of  matching  seen  here  between  the  driver  model  predictions  and 
the  measured  test  data  seen  in  Figures  5-46  and  5-47,  the  driver  model  time  delay  parameter 
had  to  be  increased  significantly  from  0.1  seconds,  used  during  previous  validation 
comparisons,  to  0.30  seconds.  Also,  because  of  the  elevated  lateral  acceleration  condition 
being  experienced  during  this  test  maneuver  and  the  likelihood  of  nonlinear  tire  properties 
playing  a  more  significant  role,  a  nonlinear  vehicle  model  ^  was  used  with  the  TACOM 
driver  model  for  this  validation  comparison.  Aside  from  an  initial  steering  wheel 
fluctuation  not  produced  in  the  model  result,  a  reasonably  good  match  occurs  between  the 
test  results  and  the  model  prediction  for  both  an^litude  and  oscillatoiy  period  of  each  of  the 
responses.  Several  simulation  runs  were  performed  initially  with  smaller  values  of  driver 
time  delay,  all  resulting  in  more  well  damped  and  less  oscillatory  behavior.  It  was  not  until 
the  driver  time  delay  was  increased  beyond  0.25  seconds  that  the  level  of  agreement  seen 
here  was  established.  As  the  driver  time  delay  is  increased  to  even  larger  values,  such  as 
0.35  sec,  the  basic  response  of  the  driverA^ehicle  system  tends  to  become  unstable  with 
each  of  the  successive  oscillations  growing  slowly  in  magnitude. 

The  test  and  model  results  seen  here  for  the  driver-controlled  steady  turning  maneuver  and 
a  directionally  unstable  vehicle,  seem  to  suggest  that  the  driver  workload  is  significantly 
increased  under  such  circumstances.  Not  only  is  the  level  of  steering  activity  increased 
markedly  for  the  driver,  but  the  response  time  of  the  driver  is  also  increased  (as  indicated 
by  the  larger  driver  model  time  delay  parameter  required  to  suitably  match  the  test  result). 
Ordinarily,  increases  in  either  one  of  these  TCrformance  indices  would  be  a  sign  of 
increased  task  difficulty  for  a  human  operator.^  Prior  to  even  conducting  any  such  tests,  it 
would  seem  that  the  anticipated  change  in  directional  dynamics  would  present  a  greater 
prediction  problem  for  the  driver  in  terms  of  being  able  to  judge  how  and  to  what  degree 
the  vehicle  would  respond  to  the  driver’s  steering  control  input.  This  indeed  appeared  to  be 
the  case  based  upon  the  actual  tost  results  and  the  model  predictions. 

This  discussion  also  raises  the  question  as  to  how  closed-loop  tests  involving  random 
disturbance  inputs  may  be  related  to,  or  interpreted  in  terms  of,  these  test  results  —  if  at  aU. 
Since  most  disturbance  testing  is  normally  conducted  during  straight-line  running,  or  along 
mild  circular  curves,  the  predictability  of  the  path  input  is  very  high.  However,  the 
response  of  the  vehicle,  because  it  is  being  disturbed  in  a  random-like  manner  by  the 
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excitation  input,  is  clearly  less  predictable  during  such  tests  than  if  no  disturbance  input  is 
present.  This  type  of  test  would  then  seem  to  fall  into  a  category  of  test  procedures  that 
introduces  uncertainty  into  the  vehicle  response,  and  may  be  viewed  as  a  form  of  closed- 
loop  testing  which  tasks  the  ability  of  human  operators  to  predict  and  control  the  response 
of  an  "uncertain"  vehicle.  In  this  sense  then,  the  last  sequence  of  high  oversteer  tests 
conducted  during  this  study  may  be  more  closely  related  to  random  disturbance  tests  than 
initially  thought.  In  fact,  the  unstable  directional  dynamics  encountered  during  such  tests 
can  be  viewed  as  the  disturbing  mechanism  to  the  vehicle  motion,  causing  the  driver  to 
continuously  counteract  it  with  corrective  steering  throughout  the  duration  of  the  test 
maneuver. 

Recalling  the  earlier  results  from  the  lane-change  and  obstacle  avoidance  maneuvers, 
questions  also  arise  regarding  the  mechanism  by  which  drivers  may  adjust  preview  and 
time  delay  characteristics  according  to  task  difficulty  associated  with  the  predictability  of  a 
desired  path.  Previously,  the  same  driver  preview  and  time  delay  parameters  were  required 
for  the  obstacle  course  maneuver  and  the  lane-change  maneuvers  in  order  to  match  the 
corresponding  test  results.  Since  the  obstacle  course  geometry  was  expected  to  be  less 
predictable  during  each  test  than  the  static  geometry  of  the  lane-change  maneuver,  it  seemed 
reasonable  that  the  driver  would  require  additional  "processing  time"  for  the  obstacle  course 
tests.  However,  this  did  not  seem  to  occur.  One  possibility  may  be  that  additional  time 
was  in  fact  available  to  the  driver  during  the  obstacle  course  tests  since  they  were  conducted 
at  a  slower  speed.  Another  possibility  may  be  that  the  obstacle  course  geometry  was  still 
highly  predictable  because  of  the  known  left-right  required  movements  as  well  as  their 
required  sequence.  Without  additional  testing  to  carefully  sort  out  various  alternative 
explanations,  the  actual  mechanism  by  which  drivers  may  possibly  be  affected  by  different 
path  geometry  is  not  clear.  However,  from  the  limited  data  collected  here,  it  appears  that 
modest  changes  in  path  geometry  and  its  corresponding  degree  of  predictability,  does  not 
have  a  primary  influence  on  driver  steering  behavior. 

Finally,  the  matter  of  how  parameters  for  the  TACOM  driver  model  should  be  selected  is  an 
important  issue,  particularly  if  test  data  is  not  readily  available  to  directly  guide  the 
parameter  selection  process.  Based  upon  the  above  discussion,  it  appears  that  the  TACOM 
driver  model  time  delay  parameter  should  be  selected  primarily  on  the  basis  of  task 
difficulty,  as  defined  by  how  well  behaved  and  responsive,  the  controlled  vehicle 
directional  dynamics  are  expected  to  be.  On  the  one  hand,  we  have  experimental  evidence 
from  this  study  that  a  driver  time  lag  value  of  0.1  seconds  is  reasonable  for  the  HMMWV 
and,  presumably,  a  similar  class  of  vehicles  having  relatively  sluggish  but  predictable 
directional  dynamics.  On  the  other  hand,  previous  experimental  studies  using  passenger 
cars  (differentiated  from  the  HMMWV  primarily  by  considerably  faster  directional 
dynamics)  have  identified  appropriate  values  of  the  same  driver  model  time  lag  in  the  range 
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of  0.2  to  0.3  seconds.  These  previous  results  have  been  obtained  using  both  random 
disturbance  tests  and  lane-change  maneuvers  similar  to  those  used  in  this  project.  Based 
upon  these  observations  for  vehicles  having  predictable  directional  response  characteristics, 
but  differing  in  their  relative  responsiveness,  the  following  recommendations  can  be  made 
regarding  the  selection  of  reasonable  driver  model  time  lag  and  preview  time  parameters: 

•  For  maneuvers  primarily  involving  straight-line  driving  or  mild  turning  with 
no  obstacles  in  the  immediate  path,  a  value  for  the  driver  model  time  delay 
parameter  of  approximately  0.25  seconds  is  reasonable.  Values  for  the 
driver  model  preview  time  parameter  ranging  from  about  1.50  seconds  to 
3.0  seconds  is  likewise  reasonable  for  this  class  of  maneuvers  and  most 
vehicles,  depending  upon  the  level  of  desired  damping  and  path  error 
control.  Larger  values  of  preview  time  add  more  damping,  but  sacrifice 
path  tracking  accuracy  and  system  responsiveness. 

•  For  transient  type  maneuvers  involving  lane-changes  or  maneuvering 
around  obstacles  in  tight  quarters,  a  value  for  the  driver  model  time  delay 
parameter  of  approximately  0.10  seconds  is  recommended  for  vehicles 
having  sluggish  directional  dynamics,  such  as  the  HMMWV.  For  vehicles 
having  quicker  directional  dynamics,  such  as  conventional  passenger  cars, 
values  in  the  range  of  0.15  to  0.3  seconds  for  this  parameter  are 
recommended.  Appropriate  values  for  the  driver  model  preview  time 
parameter  here  typically  would  range  from  about  0.8  seconds  to  1.5 
seconds,  again,  depending  upon  the  level  of  desired  damping,  path  error 
control,  and  the  geometry  of  the  course. 

For  vehicles  having  poor  or  unconventional  handling  qualities  (e.g.,  heavily  oversteer 
vehicles,  or  vehicles  having  directional  control  properties  not  well  understood  by  a  driver): 

•  A  value  of  0.25  seconds  or  greater  is  estimated  for  the  driver  model  time 
delay  parameter  imder  these  conditions  to  represent  likely  difficulties  human 
operators  may  have  in  controlling  such  vehicles  .  A  reasonable  range  of 
preview  times  would  be  1.0  to  3.0  seconds,  depending  upon  system 
damping  and  path  control  considerations. 

Summarizing  the  primary  conclusions  from  the  validation  testing  and  model  predictions,  it 
does  appear  from  the  validation  exercise  results  that: 

1)  The  drivers  used  in  this  test  program  did  react  more  quickly  than  what  has 
been  traditionally  reported  in  the  technical  literature  as  typical  of  "average" 
drivers  of  passenger  cars  evaluated  with  "random  disturbance"  tests  and 
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similar  lane-change  test  procedures.  The  conclusion  here  is  that  such 
differences  in  driver  response  characteristics  are  attributable  to  differences  in 
the  directional  response  qualities  of  the  controlled  vehicles  (i.e.  a  HMMWV 
versus  most  passenger  cars).  The  observed  change  in  driver  time  delay 
property  is  assumed  to  represent  typical  human  operator 
adaptation/compensation  behavior  frequently  observed  in  most  man/machine 
systems. 

2)  A  two  degree-of-ffeedom  vehicle  model  was  generally  sufficient  for 
representing  the  directional  dynamics  of  the  controlled  vehicle  within  the 
driver  model  itself  for  the  types  of  maneuvers  examined  in  this  validation 
exercise. 

and, 

3)  Regardless  of  the  observed  variations  exhibited  in  driver  steering  behavior 
during  this  test  program,  or  in  what  has  been  reported  previously  by  others 
in  the  technical  literature,  the  TACOM  model  appears  to  be  quite  capable  of 
replicating  most  of  these  observed  driver  steering  control  behavior  patterns 
through  simple  adjustment  of  two  basic  parameters. 


5.8.  Implementation  of  the  Driver  Model  in  DADS 

The  material  presented  in  this  section  of  the  report  describes  how  the  TACOM  driver  model 
was  implemented  in  a  recent  version  of  the  DADS  (Dynamic  Analysis  and  Design  System) 
computer  software  developed  by  CADSI  (Computer  Aided  Design  Software,  Inc.)  of 
Oakdale,  Iowa.  Reference  will  be  made  dining  this  discussion  to  a  number  of  FORTRAN 
code  subroutines  which  are  part  of  either  the  DADS  program  or  the  code  developed  as  part 
of  this  project.  Most  of  this  code  appears  in  Appendices  D  and  E. 

Figure  5-48  provides  an  overview  of  the  interaction  between  the  DADS  program,  which 
would  normally  be  used  in  this  context  to  represent  the  dynamics  of  a  particular  vehicle, 
and  the  TACOM  driver  model.  The  driver  model  software  (represented  here  in  part  by 
subroutines  DRIVER,  TRANS,  and  TRAJ)  and  most  other  user-defined  programs, 
interface  with  the  DADS  software  through  a  subroutine  entitled  USER49  seen  in  the  center 
of  the  figure.  (Depending  upon  the  installation,  "USER49"  may  have  a  different  name.) 
USER49  is  used  to  place  FORTRAN  "CALLS"  to  the  driver  model  subroutines  and  to 
update  DADS  with  results  from  the  driver  model  calculations  during  the  course  of  a 
simulation  run.  The  USER49  subroutine  therefore  acts  as  communication  interface 
between  DADS  and  other  external  programs  not  inherently  part  of  the  DADS  package. 
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A  typical  sequence  of  events  related  to  the  driver  model  calculations  during  an  integration 
time  step  would  be  as  follows: 


•  DADS  updates  its  tire  forces  through  calls  to  the  tire  model  in  subroutine 
TIREF 

•  DADS  calls  USER49  to  handle  any  external  user-defined  calculations  (such 
as  the  driver  model) 

•  USER49  calls  the  primary  driver  model  subroutine  DRIVER  to  calculate  a 
new  steering  control.  Information  such  as  current  vehicle  position, 
velocity,  and  steering  angle  are  passed  to  DRIVER. 

•  DRIVER  updates  its  information  on  vehicle  speed  and  tire  properties 
available  in  the  COMMON  BLOCKS 

•  DRIVER  calls  driver  model  subroutine  TRANS  to  update  the  transition 
matrix  of  the  internal  linear  vehicle  model  used  by  DRIVER  to  predict  future 
positions  within  the  preview  interval 

•  DRIVER  then  calls  subroutine  TRAJ  to  obtain  "desired  path"  information 
and  compares  it  with  its  own  predicted  position  calculations  to  obtain  an 
estimate  of  previewed  path  error 

•  DRIVER  then  calculates  the  time  lagged  optimal  preview  steering  control 
and  returns  it  to  subroutine  USER49 

Prior  to  the  start  of  the  simulation,  a  number  of  initializations  have  to  first  occur  in  the 
driver  model  software.  Parameters  describing  the  basic  features  of  the  vehicle  being 
simulated  by  the  DADS  program  must  be  passed  to  the  driver  model  or  read  in  from 
external  files.  These  parameters  include  such  items  as  the  vehicle  weight,  its  yaw  moment 
of  inertia,  vehicle  speed,  fi-ont  and  rear  tire  cornering  stiffnesses,  and  the  vehicle  c.g. 
location  with  respect  to  the  front  and  rear  suspensions.  The  vehicle  parameters  passed  to 
the  driver  model  at  this  point  are  used  to  define  its  own  internal  simplified  representation  of 
the  complete  vehicle  being  represented  by  the  DADS  code.  Each  of  these  parameters 
appeared  earlier  as  part  of  the  section  5.5  discussion  and  a  sample  list  appears  in  Figure  5- 
12.  In  addition  to  these  basic  vehicle  parameters,  the  driver  model  time  delay  and  preview 
time  parameters  must  also  be  made  available  to  the  driver  model  either  through  USER49  or 
fi’om  an  external  file.  The  only  remaining  item  to  enter  is  the  set  of  x-y  coordinates 
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defining  the  desired  path  for  the  driver  model  to  follow.  Figure  5-49  outlines  this 
initialization  process  for  the  start  of  a  simulation  run. 

Once  the  DADS  simulation  begins,  USER49  is  called  at  each  integration  time  step  and  in 
turn  calls  the  driver  model  software.  Figure  5-50  shows  the  sequence  of  driver  model 
calculations  occurring  during  each  integration  time  step.  For  most  nonlinear  vehicle 
calculations  for  which  large  programs  such  as  DADS  would  ordinarily  be  used,  speed 
changes  due  to  cornering  or  braking  are  kept  track  of  in  the  driver  naodel  by  communication 
with  the  DRIVER  MODEL  COMMON  BLOCKS.  Similarly,  front  and  rear  tire  cornering 
stiffness  alterations  are  communicated  to  the  driver  model  from  DADS  through  these  same 
common  blocks.  Updating  of  the  transition  matrix  of  the  internal  vehicle  model  can  then  be 
performed  continuously  or  in  an  intermittent  fashion  by  the  driver  model  to  maintain  a 
"current”  representation  of  the  controlled  vehicle  under  changing  operating  conditions. 

The  driver  model  common  blocks  must  be,  updated  periodically  by  an  appropriate  DADS 
subroutine,  depending  upon  the  particular  parameter  in  question.  For  example,  tire 
cornering  stiffness  values  can  most  easily  be  updated  by  the  DADS  tire  model  subroutine. 
In  this  application,  the  DADS  tire  model  subroutine  is  called  TIREF,  as  seen  in  Figure  5- 
48,  and  cornering  stiffness  calculations  for  each  of  the  HMMWV  tires  is  performed  within 
this  subroutine  at  each  time  step  of  the  simulation.  A  routine  was  written  by  TACOM  to 
obtain  a  local  slope  from  the  nonlinear  tire  data  tables  ordinarily  entered  as  part  of  the 
DADS  input.  Under  low  lateral  acceleration  operating  conditions,  where  a  tire  experiences 
only  a  small  range  of  sideslip  and  the  cornering  stiffness  remains  approximately  constant, 
the  effect  of  updating  the  tire  cornering  stiffness  obviously  has  little  effect.  However, 
under  higher  latoial  acceleration  conditions  where  the  tire  properties  are  normally  changing 
significantly,  such  updating  can  be  important  in  terms  of  keeping  the  driver  model 
"informed"  about  current  operating  conditions  and  enabling  it  to  better  predict  future  vehicle 
states. 

Example  calculations  from  the  DADS  /  TACOM  driver  model  implementation  are  seen  in 
Figures  5-51  and  5-52  for  a  simulated  HMMWV  performing  a  12-ft  by  100-ft  lane-change 
maneuver  at  a  speed  of  50  mph.  The  plots  seen  here  were  produced  by  the  DADS  post 
processor  software.  Figure  5-51  shows  the  average  front  wheel  steer  angle  (radians) 
versus  time  (sec)  calculated  by  the  TACOM  driver  model  during  the  DADS  run.  The 
corresponding  vehicle  trajectory,  in  units  of  inches  of  lateral  and  longitudinal  displacement 
of  the  vehicle  c.g.,  is  seen  in  the  lower  portion  of  the  same  figure.  Figure  5-52  shows  time 
histories  of  lateral  acceleration  (inches/sec/sec)  and  yaw  rate  (radians/sec)  for  the  same 
maneuver.  As  seen,  the  predicted  responses  are  quite  similar  to  previous  examples  and  test 
data  for  comparable  lane-change  maneuvers.  Continuous  updating  of  the  driver  model 
transition  matrix  (for  changes  in  speed  and  tire  cornering  stiffnesses)  was  occurring 
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Figure  5-50.  Driver  Model  Calculations  During  Integration  Loop 
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throughout  this  ran.  However,  because  the  peak  lateral  accelerations  of  approximately  70 
in/sec/sec  or,  0.18  g's,  seen  here  would  categcxize  this  ran  as  a  relatively  low  lateral 
acceleration  maneuver,  such  updating  of  the  driver  model  transition  matrix  would  have  little 
beneficial  effect  in  this  particular  example. 

Another  example  from  the  DADS  /  TACOM  driver  model  simulation  is  seen  in  Figure  5-53 
for  a  circular  turning  maneuver  along  a  500-ft  radius  path  at  a  speed  of  35  mph.  Time 
histories  of  the  average  front  wheel  steering  angle  (radians)  and  the  corresponding  lateral 
acceleration  (g's)  are  shown.  A  slight  amount  of  overshoot  is  seen  at  about  the  4-second 
point  in  the  ran  as  the  vehicle  "transitions"  from  the  lOO-ft  straight  approach  tangent  in  to 
the  circular  curve. 

Lastly,  a  sequence  of  animation  frames  are  shown  in  Figures  5-54  and  5-55,  illustrating  the 
same  DADS  maneuver  performed  at  a  highCT  speed  of  50  mph.  During  this  ran,  the 
simulated  HMMWV  is  experiencing  a  significant  amount  of  sideslip  and  diminished 
directional  stability  because  of  reduced  tire  traction  capabilities  and  a  large  rearward- 
positioned  payload.  The  tires  are  operating  under  highly  variable  sideslip  conditions  during 
this  maneuver  and  continuous  updating  of  the  localized  tire  cornering  stiffnesses  assists  the 
driver  model  in  better  maintaining  the  desired  path  and  directional  stability  in  this  example 
case. 

If  the  transition  matrix  is  not  updated,  unlike  the  previous  example  ran,  the  driver  model 
would  use  the  initial  values  of  tire  cornering  stiffness  and  vehicle  speed  prevailing  at  the 
start  of  the  simulation  to  calculate  the  transition  matrix.  As  the  simulation  progresses  and 
significant  side-to-side  load  transfer  and  vehicle  sideslip  occurs,  the  tire  properties  and 
localized  cornering  stiffness  values  would  depart  from  their  initial  values  prevailing  at  the 
start  of  the  maneuver.  The  change  in  directional  dynamics  in  this  case  would  not  be  sensed 
by  the  driver  model  and  the  vehicle  would  be  steered  differently.  A  preliminary  test  ran 
performed  with  no  transition  matrix  updating  (for  the  same  50  mph  case)  produced  a 
directionally  stable  result,  but  large  path  errors  showing  the  vehicle  off-tracking  several  feet 
to  the  outside  of  the  lane  during  the  cornering  maneuver. 

In  most  nonlinear  simulations,  the  driver  model  can  still  be  used  effectively  without  use  of 
transition  matrix  updating  provided  that  large  changes  in  tire  properties  or  speed  do  not 
occur  for  extended  periods  of  time  during  the  maneuver.  Examples  of  this  might  be  lane- 
change  maneuvers  which  may  have  large  peak  levels  of  lateral  acceleration  (e.g.  above  0.4 
g's)  but  which  are  relatively  short  in  duration.  The  driver  model  may  be  temporarily  less 
accurate  during  these  peak  acceleration  periods  in  predicting  the  future  position  of  the 
vehicle,  but  the  net  effect  will  generally  be  small  when  compared  to  an  identical  run  having 
continuous  transition  matrix  updating.  For  some  users,  the  additional  execution  time  and 
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Figure  5-54.  DADS  /  TACOM  Driver  Modei  for  HMMWV 

Aiong  Circuiar  Turn  at  50  mph 
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Figure  5-55.  DADS  /  TACOM  Driver  Model  for  HMMWV 

Along  Circular  Turn  at  50  mph 
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computational  requirements  of  continuously  updating  the  driver  model  transition  matrix 
may  be  of  concern  and  not  actually  needed  for  most  of  their  maneuvers.  In  this  case,  the 
call  to  the  TRANS  subroutine  from  within  the  DRIVER  subroutine  may  be  removed  or 
temporarily  commented  out. 

It  should  also  be  remarked  here  that  the  "notion"  of  updating  the  transition  matrix  is  in  a 
sense  analogous  to  human  operator  adaptation  behavior  observed  during  experimental  tests 
of  man/machine  systems  during  which  the  d^amics  of  the  controlled  element  is  being 
altered.  Previous  research  has  shown  that  human  operators  can 

adapt  quite  quickly  to  large  changes  in  the  dynamics  of  the  controlled  plant  during  the 
course  of  a  tracking  task  experiment.  Very  often  this  adaptation  or  "re-identification" 
process  by  the  human  subject  can  occur  within  less  than  a  second  of  time.  Consequently, 
including  or  removing  this  call  to  the  TRANS  subroutine  can  be  a  way  of  representing  (or 
not)  the  ability  of  drivers  to  adapt  to  changing  vehicle  dynamics  properties  during  the 
course  of  a  maneuver.  The  code  that  appears  in  Appendix  D  for  the  driver  model  shows 
the  call  from  within  the  DRIVER  subroutine  to  the  TRANS  subroutine  enabled  as  the 
default. 


5.9.  Path  Planning  and  Obstacle  Detection  Algorithm 

This  and  the  next  section  of  the  report  describe  two  secondary  tasks  undertaken  during  the 
project  which  were  intended  to  supplement  the  basic  driver  steering  model  described  in 
earlier  sections  of  the  report.  The  first  option,  discussed  in  this  section,  describes  a  path 
planning  algorithm  which  could  be  used  to  generate  a  "desired  path"  input  for  the  basic 
steering  control  model.  Instead  of  the  program  user  specifying  a  set  of  x-y  coordinates  for 
the  vehicle  to  follow  (such  as  the  center-line  of  a  road),  the  program  user  would  instead 
provide  a  more  general  scene  description  of  the  road  geometry  and  any  obstacles.  The  path 
planning  algorithm  would  then  select  the  specific  desired  path  input  for  the  steering  control 
model  to  follow  based  upon  an  analysis  of  the  scene  data. 

Initially,  several  approaches  were  considered  for  implementing  a  "path  planning"  capability 
within  the  driver  model.  The  method  described  here  is  based  upon  compromises  between 
computational  efficiency  and  assumed  capabilities  of  human  operators  in  visually  detecting 
obstacles  and  selecting  paths.  The  basic  outline  of  the  algorithm  used  to  represent  a 
possible  path  planning  capability  for  the  driver  model  is  seen  in  Figures  5-56  and  5-57. 
The  basic  idea  of  the  algorithm  is  to  sweep  a  forward  radial  area  ahead  of  the  vehicle  with 
radial  lines  (or  rays)  originating  at  the  vehicle.  A  radial  profile  of  any  obstacles  or  lefi/right 
boundary  lines  detected  during  a  sweep  is  then  constructed.  A  "centroid-like"  point  from 
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1 .  Transform  specified  left  and  right  boundary  lines  from  (x-y)  cartesian 
inertial  coordinates  to  (r-theta)  polar  coordinates  (centered  in  the  vehicle 
body  axes). 

2.  Transform  circular  obstacle  definitions,  similarly,  from  cartesian  to  polar 
coordinates. 

3 .  Obstacle  detection  and  path  selection: 

a.  generate  radial  rays  from  -  to  +thetaniax  in  increments  of  delth 

i.  step  along  ray  until  impact  with  boundary  or  obstacle  or  rmax 
exceeded 

ii  record  rand  theta  values  at  impact  &  store  as  part  of  r(theta) 
profile 

b.  from  stored  r(theta)  profile: 

i.  calculate  r*  {e.g.  sum[r(i)]  /  i  } 

iL  calculate  theta*  {e.g.  [r(i)  •  theta(i)]  /  sum[r(i)]  } 

c.  check  to  see  if  r*  lies  within  r(theta)  profile 

i.  if  yes,  proceed  to  step  d. 

ii.  if  no,  (left-right  choice  possible),  then  perform  steps  a.  and  b. 

twice: 

A.  once  from -thetamax  to  0 

B.  once  from  0  to +dietainax 

C.  compare  r*  and  theta*  from  A.  and  B. 

D.  select  r*  having  largest  value 

d.  transform  r*(theta*)  point  to  cartesian  point  and  pass  to  steering  model 

as  input 

e.  if  r*  is  less  than  a  defined  rmin.  activate  closed-loop  driver  braking 

control  model  to  stop  in  distance  r*. 

4.  End  of  integration  loop.  Increment  position  and  repeat 


Figure  5-56.  Example  Path  Planning  Algorithm  for  the 
Driver  Model  (during  integration  loop) 
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this  profile  is  calculated  which  acts  as  the  target  point  for  the  steering  control  model  to  then 
follow. 

Figures  5-57  and  5-58  show  a  hypothetical  driver/vehicle  system  approaching  a  field  of 
obstacles.  The  first  figure  shows  the  vehicle  just  entering  the  field  and  detecting  the  first 
obstacle.  The  second  figure  shows  the  vehicle  at  an  advanced  position  now  detecting  all 
obstacles  and  moved  somewhat  to  the  right  of  the  first  obstacle.  The  r*  and  0*  quantities 
appearing  in  these  figures  represent  "centroid-like"  coordinates  of  the  driver  field  of  view. 
At  any  point  in  time,  the  (r*,6*)  coordinate  (or  some  variation  of  it)  would  be  used  as  a 
point  located  on  and,  over  time,  defining  the  desired  path  to  be  followed  by  the  driver 
steering  control  model.  The  r(0)  vs  0  graph  simply  represents  unobstructed  sight  distance 
in  the  driver's  field  of  view  out  to  some  finite  maximum  distance.  The  (r*,0*)  point  moves 
to  the  left  or  right  based  upon  the  particular  r(0)  profiles  generated  in  the  field  of  view. 

As  the  scene  becomes  more  crowded  or  the  maneuvering  field  limited,  the  centroid-like 
quantity  r*(0*)  will  move  closer  to  the  driver  thereby  resulting  in  a  shortening  of  the 
preview  distance  used  in  the  steering  control  strategy.  This  is  a  desirable  effect  since  most 
drivers  will  reflect  this  same  basic  behavior  pattern  under  similar  circumstances. 

The  same  preview  distance  "shortening  mechanism"  can  be  used  to  trigger  the  start  of  a 
closed-loop  braking  model  such  as  the  one  described  in  the  next  section  5.10.  For 
example,  if  r*(0*)  becomes  less  than  some  rmm  level  needed  for  moderate  braking  under 
the  prevailing  tire/surface  friction  conditions,  the  brakes  would  be  applied  in  a  closed-loop 
manner  so  as  to  bring  the  vehicle  to  a  stop  in  a  distance  of  rmin-  During  the  course  of  the 
braking  maneuver,  the  obstacle  detection/path  planning  algorithm  would  still  be  active,  so 
that,  if  an  "opening"  in  the  obstacle  field  was  detected  prior  to  the  stop,  the  braking  could 
be  abandoned  and  the  vehicle  steered  out  through  the  "opening."  Acceleration  and  speed 
control  of  the  vehicle  could  be  controlled  by  a  counter-strategy. 

A  simple  computer  program  (shown  listed  in  Appendix  F)  was  written  to  implement  and 
test  the  basic  path  planning  algorithm  outlined  here.  The  algorithm  provides  for  a  set  of  left 
and  right  boundaries  in  addition  to  a  number  of  obstacles  in  the  driver  field  of  view.  The 
left  and  right  boundaries  are  represented  as  arbitrary  x-y  tabular  data  (with  respect  to  an 
inertial  fiame  of  reference)  and  the  obstacles  as  circular  objects  of  arbitrary  radii  centered  at 
designated  x-y  (inertial  frame)  locations.  The  computer  code  that  was  written  to  test  the 
described  algorithm  requires  input  of  those  basic  items,  in  addition  to  such  things  as  driver 
location,  orientation,  field  of  view,  and  maximum  sight  distance.  At  each  position,  the 
program  then  calculates  the  r(0)  profile  and  the  centroid-like  location,  r*(0*),  for  that 
particular  scene.  By  performing  these  calculations  in  a  sequential  fashion  with  the  driver 
moving  forward  toward  the  desired  centroid-like  location,  a  path  is  generated  (as  defined 
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by  the  sequential  locations  of  that  quantity).  This  path  then  represents  the  output  of  the 
path  planning  module  and  acts  as  an  input  to  the  driver  steering  control  module. 

Two  examples  are  presented  next  which  illustrate  the  operation  of  the  path  planning 
algorithm  used  in  conjunction  with  the  steering  control  model.  Figure  5-59  shows  a  lane- 
change  course  using  left  and  right  boundaries  (instead  of  a  desired  x-y  path)  to  guide  the 
driverA^ehicle  system  during  the  path-following  maneuver.  No  obstacles  are  present  in  this 
run.  Results  in  the  form  of  time  histories  are  shown  in  Figures  5-60  and  5-61.  The 
simulated  vehicle  is  a  loaded  HMMWV  travelling  at  60  mph.  The  specified  field  of  view  is 
+/-  0.3  radians.  The  maximum  look-ahead  distance,  rmax*  is  150  ft. 

As  a  second  example.  Figure  5-62  shows  a  course  layout  in  which  the  left  and  right 
boundaries  are  straight  line  segments  defining  the  left  and  right  road  boundaries  of  an 
obstacle  course  similar  to  that  used  during  the  test  program.  Centered  in  the  left-hand  lane 
and  direcdy  in  fijont  of  the  vehicle  at  the  start  of  the  run  is  a  circular  obstacle  with  a  diameter 
of  12  ft.  An  identical  second  obstacle  is  located  centered  in  the  right-hand  lane  1 12  ft 
beyond  the  first  obstacle.  Results  from  this  run  are  also  seen  as  a  sequence  of  time 
histories  in  Figures  5-63  and  5-64.  After  the  start  of  the  run,  the  vehicle  is  steered  to  the 
right  away  from  and  around  the  first  obstacle.  As  the  vehicle  moves  forward  beyond  the 
first  obstacle,  it  is  steered  back  to  the  left  around  the  second  obstacle.  The  vehicle  then 
encounters  the  leftMght  road  boundaries  which  guide  it  out  the  exit  in  the  right-hand  lane. 

Note  that  the  only  information  provided  to  the  path  planning  algorithm  are  the  left  and  right 
boundaries  (located  with  respect  to  an  inertial  reference  frame)  and  location  and  size  of  any 
obstacles.  The  model  thus  decides  "where  to  go"  (by  means  of  the  path  planning  module) 
as  well  as  "how  to  get  there"  (by  means  of  the  steering  control  model).  The  algorithm 
continuously  adjusts  the  driver  preview  parameter  and  its  "transition  matrix"  based  upon 
the  obstacles  or  boundary  constraints  present  in  the  field-of-view.  For  example,  in  the 
obstacle  course  ran  seen  in  Figure  5-62,  the  preview  distance  was  shortened  by  the  model 
to  a  value  of  about  25  feet  when  the  vehicle  was  nearing  an  obstacle/gap,  and  was 
lengthened  to  approximately  100  ft  (up  to  the  maximum  sight-distance  specified)  at  the  start 
and  end  of  the  course  where  no  obstacles  were  immediately  present.  This  version  of  the 
the  path  planning  model  uses  a  single  point  in  the  preview  interval  to  guide  and  steer  the 
vehicle  in  order  to  minimize  the  computational  requirements  of  the  algorithm. 
Consequendy,  the  steering  responses  seen  with  this  type  of  model  will  be  somewhat  more 
variable  than  one  in  which  an  average  of  several  points  over  the  preview  interval  are  used  in 
the  computation  (as,  for  example,  the  type  of  calculation  performed  by  the  basic  version  of 
the  TACOM  steering  control  model  presented  earlier). 
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No  Obstacles  Present  in  this  Example 


(not  to  scale) 


Figure  5-59.  Lane-Change  Geometry  for  the  Example  Calculation 
using  the  Path  Planning  Algorithm 
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Figure  5-60.  Example  Calculation  using  the  Path  Planning 
Algorithm  -  Lane  Change  Maneuver 
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Figure  5-61.  Example  Calculation  using  the  Path  Planning 
Algorithm  -  Lane  Change  Maneuver 
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Figure  5-62.  Obstacle  Course  Geometry  for  the  Example 

Calculation  using  the  Path  Planning  Algorithm 
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Figure  5-63.  Example  Calculation  using  the  Path  Planning 
Algorithm  -  Obstacle  Course  Maneuver 
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Figure  5-64.  Example  Calculation  using  the  Path  Planning 
Algorithm  -  Obstacle  Course  Maneuver 
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The  advantages  of  using  a  path  planning  feature  in  combination  with  the  driver  steering 
control  model  are:  1)  geometric  descriptions  of  the  roadway  or  obstacle  course  can  often  be 
supplied  in  a  simple  manner,  and  2)  the  path  planning  module  automatically  determines  the 
path  to  be  followed  based  upon  the  boundary  and  obstacle  data.  The  chief  disadvantage  is 
the  large  increase  in  computational  effort  used  by  such  algorithms  in  determining  the  path. 
More  efficient  computational  schemes  could  no  doubt  be  offered  to  improve  upon  the  basic 
concept  described  in  this  report.  In  general,  use  of  a  path  planning  model  is  probably  best 
suited  to  driving  scenarios  involving  arbitrary  obstacle  courses  for  which  tracking  of  a 
particular  pre-determined  path  is  not  required,  or,  a  likely  path  is  not  obvious  from  simple 
examination  of  the  course  geometry. 


5.10.  Driver  Model  Option  for  Closed-Loop  Braking 

The  TACOM  driver  model  discussed  in  the  previous  sections  of  the  report  is  obviously 
aimed  at  simulating  the  closed-loop  steering  behavior  of  drivers.  No  consideration  of  how 
drivers  might  also  control  or  modulate  brake  pressure  during  braking  maneuvers  was 
initially  included  in  that  model.  However,  in  order  to  study  the  effects  of  active  driver 
modulation  of  brake  pressure  during  vehicle  deceleration  maneuvers,  it  will  ultimately  be 
necessary  to  augment  and  extend  the  capabilities  of  the  driver  steering  control  model  in 
futiu-e  studies.  This  section  describes,  in  general  terms,  one  possible  method  by  which 
closed-loop  braking  behavior  of  drivers  could  be  modelled.  Much  of  the  proposed  closed- 
loop  braking  model  discussion  that  follows  was  initially  suggested  in  a  small  study 
performed  by  UMTRI  for  the  Rockwell  International  Corporation.^^ 

The  test  data  collected  under  this  project  for  the  HMMWV  was  intended,  in  part,  to  support 
future  development  and  validation  of  closed-loop  braking  models  by  TACOM.  Those 
braking  tests,  as  discussed  previously  in  section  5.6,  were  all  conducted  intentionally  as 
closed-loop  braking  tasks  during  which  the  driver  applied  braking  so  as  to  bring  the  vehicle 
to  a  uniform  stop  at  a  specified  point  on  the  test  track.  Recall  that  the  requested  stopping 
distances  were  varied  in  a  random-like  manner  from  test  to  test  to  prevent  the  test  drivers 
from  "automating"  their  brake  pressure  control  strategy.  Data  was  collected  for  braking-in- 
a-tum  as  well  as  for  straight-line  braking  maneuvers. 

5.10.1.  Closed-Loop  Brake  Application  Strategy.  The  basic  idea  underlying  the 
proposed  model  of  driver  braking  behavior  is  for  the  model  to  apply  appropriate  levels  of 
brake  pressure  to  bring  the  vehicle  to  rest  at  a  future  position  in  space.  The  driver  is 
assumed  to  be  equipped  with  a  simple  "understanding"  of  the  longitudinal  dynamics  of  the 
vehicle  in  response  to  command  pressure  inputs.  In  addition,  the  driver  is  presumed  to  act 
in  a  time-delayed  fashion  so  that  the  command  pressure  calculated  by  the  model  is  applied 
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to  the  brake  system  after  some  inherent  driver  delay.  In  the  model,  the  simple 
"understanding"  is  represented  by  the  longitudinal  dynamics  of  a  point-mass  subject  to  a 
braking  or  retardation  force.  In  essence,  the  driver  model  has  a  simplified  "internal  model" 
of  the  longitudinal  dynamics  of  the  vehicle  being  operated,  and  can,  therefore,  predict  or 
estimate  future  vehicle  position  in  response  to  command  pressure  inputs.  (This  is 
essentially  an  extension  of  the  same  basic  optimal  control  approach  applied  successfully 
during  this  project  for  the  lateral  steering  control  of  vehicles.) 

Without  presenting  the  mathematical  derivation  here,  the  equation  that  results  from  this 
model  is  one  that  relates  an  ideal  driver  command  pressure,  P*(t),  to  current  longitudinal 
vehicle  position,  speed,  and  desired  stopping  point: 

P*(t)  =  m[V(t)]2/{2K[xd-x(t)]  }  (5.10-1) 

where, 

t  is  time  firom  the  start  of  the  braking  maneuver 

P*(t)  is  the  calculated  ideal  driver  command  pressure  (brake  pedal)  at  each  point 
in  time  during  the  braking  stop  (the  calculated  "control  variable"  here) 

m  is  the  total  mass  of  the  vehicle 

V(t)  is  the  forward  speed  of  the  vehicle  at  each  point  in  time  during  the  braking 
stop 

K  is  a  linear  gain  factor  relating  driver  command  pressure  to  total  retardation 
force  fibs  /  psi) 

xd  is  the  desired  stopping  distance  from  the  point  of  brake  application 

and, 

x(t)  is  the  vehicle  longitudinal  position  at  each  point  in  time  during  the  braking 
stop 

The  ideal  command  pressure,  P  (t),  is  then  delayed  an  amount  td  seconds  (driver  time 
delay  for  braking),  resulting  in  the  final  equation  for  the  driver  modulated  command 
pressure,  P(t),  which  is  the  acftial  pressure  applied  to  the  brake  system: 

P(t)  =P*(t-td)  (5.10-2) 
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As  seen,  the  closed-loop  equation  (5.10-1)  is  quite  simple  and,  in  fact,  is  a  rearrangement 
of  the  well  known  physics  formula  (applied  on  a  point-in-time  by  point-in-time  basis) 
relating  stopping  distance,  x,  to  initial  speed,  V,  and  subject  to  a  constant  deceleration,  D, 
[  X  =  V2  /  (2  D)  ]  The  driver  model,  in  effect,  selects  deceleration  at  each  point  in  time 
using  this  formula,  translates  it  to  a  command  pressure  equivalent,  based  upon  brake  gains 
and  vehicle  weight,  and  then  delays  it  in  time  to  account  for  an  assumed  driver  lag. 
Although  equation  (5.10-1)  was  not  derived  from  this  particular  viewpoint,  it  is  helpful  to 
see  an  analogy  between  it  and  a  simple  explanation  in  basic  physics. 

Figure  5-65  shows  an  example  time  history  for  the  closed-loop  driver  command  pressure 
predicted  by  the  model  for  a  braking  stop  from  30  mph  and  a  desired  stopping  distance  of 
150  feet.  The  calculation  is  for  a  5-axle  tractor-semitrailer  and  was  simulated  using  a 
modified  version  of  the  UMTRI  Phase  4  commercial  vehicle  model.^  Since  the  driver 
braking  model  approximates  the  deceleration  gain  of  the  braking  system  by  a  simple  gain 
constant,  K,  noted  above,  differences  can  exist  between  the  driver  "understanding"  of  the 
pressure-retardation  force  relationship  and  that  of  the  actual  brake  system.  This  would  be 
particularly  true  for  vehicles  having  highly  nonlinear  torque-pressme  relationships  and 
significant  levels  of  hysteresis,  or,  for  cases  of  low  road  surface  friction  where  the 
available  retardation  torque  is  limited  by  the  surface  friction.  Since  the  vehicle  used  in  this 
example  possessed  fairly  linear-like  brakes  (aside  from  the  usual  push-out  pressure 
characteristic)  and  only  modest  levels  of  brake  hysteresis,  reasonable  predictions  of 
command  pressure  would  be  expected  by  the  model  when  sufficient  tire-road  friction  is 
available.  Figure  5-65  seems  to  suggest  this.  The  continued  "drooping"  of  treadle 
(command)  pressure  at  the  end  of  the  stop  is  attributable  to  brake  hysteresis,  which  causes 
a  lagging  of  brake  torque  requested  by  the  model  during  the  pressure  reduction  phase.  As 
indicated  in  the  next  section,  5.10.2  Closed-Loop  Brake  Release  Strategy,  this  basic  form 
of  brake  application  will  normally  be  interrupted  in  the  model  by  front-axle  wheel  locks 
and/or  vehicle  instabilities  with  more  demanding  stops  attempted  for  shorter  distances. 

Figure  5-66  illustrates  the  differences  between  the  simple  linear  retardation  function 
expected  by  the  driver  model  and  that  experienced  by  an  actual  vehicle.  For  the  high 
friction  surface  (top  diagram)  where  the  retardation  forces  primarily  derive  from  the  torque 
limitation  of  the  brake  (summed  over  the  vehicle),  the  primary  differences  lie  in  the 
nonlinearities  present  in  the  brake  system  itself.  For  the  case  of  the  low  friction  surface 
(bottom  diagram),  additional  saturation- type  nonlinearities  are  introduced  because  of  the 
tire-surface  friction  limitations.  Consequently,  mild  over-  or  under-estimations  of  total 
brake  retardation  forces  by  the  driver  model  under  conditions  of  high  surface  friction,  can 
become  exaggerated  under  low  friction  conditions.  This  would  especially  be  true  for  a 
loaded  vehicle  and  low  friction  surface  combination  since  the  command  pressure 
"expectation"  requested  by  the  driver  model  will  be  scaled  up  by  the  weight  of  the  vehicle 
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Figure  5-65.  Example  Prediction  of  Command  Pressure 
from  the  Closed-Loop  Driver  Braking  Model 
during  a  Controlled  Stop 
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Figure  5-66.  Comparison  of  Simple  Driver  Model  Braking 

Expectation  with  Actual  Retardation  Properties 
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from  the  empty  vehicle  condition  on  the  same  surface.  This  will,  in  turn,  result  in  a 
significant  over-estimation  of  the  available  retardation  torque  on  the  part  of  the  model  as 
indicated  in  Rguie  5-66  (lower  diagram). 

In  spite  of  this,  even  in  cases  of  significant  ovor-estimation  of  the  available  retardation 
torque  by  the  model,  reasonable  predictions  of  command  pressure  demand  can  still  be 
obtained  from  the  model  Much  of  this  "success"  can  be  attributed  to  the  other  half  of  the 
driver  model  behavior,  discussed  in  the  next  section,  which  models  how  brake  pressure  is 
released  under  various  conditions,  thereby  preventing  the  model  from  operating  for 
extended  periods  of  time  in  modes  of  mismatch  or  over-estimation.  Further  refinement  or 
improvements  to  the  driver  "expectation  function"  of  retardation  torque  are  of  course 
possible,  such  as  accounting  for  the  brake  system  push-out  pressure  (dead-zone),  or, 
introducing  nonlinearities  into  the  expectation  ftinction. 

5.10.2.  Closed-Loop  Brake  Release  Strategy.  In  order  to  represent  a  basic 
response  to  loss  of  steering  due  to  front  axle  lock-up  and/or  various  forms  of  vehicle 
directional  instability  that  can  occur  during  heavy  braking,  the  closed-loop  braking  model 
may  have  a  number  of  programmable  "rules"  for  temporarily  releasing  driver  commanded 
pressure  diudng  a  braking  maneuver.  TTie  following  "rules"  define  conditions  for  possible 
pressure  release  by  the  driver  model: 

A)  left  and  right  axle  wheel  slip  values  both  exceed  value  of  Smax, 

(front  -axle  lock) 

or, 

B)  absolute  value  of  path  error  exceeds  value  of  Y max, 

(vehicle  12-foot  lane  exceedance) 

or, 

C)  absolute  value  of  vehicle  sideslip  angle  exceeds  value  of  Bmax, 

(yaw  instability) 

or, 

D)  absolute  value  of  tractor-semi  articulation  angle  exceeds  value  of  Gmax, 
(jackknife  and/or  trailer  swing  for  an  articulated  vehicle) 

and, 

E)  forward  speed  greater  than  Vmin. 

(ignore  brake  release  "rules"  at  very  low  speeds) 

Example  values  for  these  parameters  for  a  tractor-semitrailer  might  be: 

Smax  =  0.5 
Bmax  =  10  degrees 
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Ymax  =  4.0  feet 

Gmax  =  10  degrees. 

Vmin  =  10  ft/sec 

Figure  5-67  shows  a  time  history  of  driver  command  pressure  from  the  closed-loop  driver 
model  for  a  braking  stop  on  a  low  friction  surface  in  which  front-axle  lock-up  is  occurring 
and  causing  interruption  of  the  applied  command  pressure  based  upon  "rule"  A)  above.  A 
by-product  of  this  "brake  pumping"  activity  by  the  driver  model  is  that  following  each 
interruption,  the  next  application  by  the  model  is  successively  higher  in  order  to  meet  the 
increased  stopping  demand  caused  by  the  previous  brake  releases.  The  increasing 
command  pressure,  or  upward  ramping,  seen  during  the  first  two  application  cycles  by  the 
driver  model  also  reflects  "over-estimation"  behavior  of  the  model  as  discussed  in  the 
previous  section  and  Figure  5-66.  The  "over  estimation"  is  caused  by  insufficient  tire- 
surface  friction  (semitrailer  and  tractor  rear  lock-ups  are  occurring  prior  to  a  tractor  front- 
axle  lock-up  during  these  two  application  cycles). 

Overall,  the  basic  command  pressure  modulation  by  the  closed-loop  driver  model  seems  to 
behave  reasonably  given  the  simplicity  of  the  model.  Refinements  of  this  model  are 
certainly  possible  based  upon  some  of  the  braking  data  collected  under  this  project. 
Additional  driver-vehicle  experiments  could  also  be  designed  and  conducted  to  extract 
information  useful  to  a  more  comprehensive  modelling  effort 

In  summary,  it  is  assumed  that  the  closed-loop  braking  model  outlined  above  possesses 
certain  capabilities  and  inherent  properties.  First,  the  ability  to  select,  in  at  least  a  simple 
manner,  an  appropriate  value  of  command  pressure  to  bring  the  vehicle  to  a  stopping  point. 
This  suggests  an  ability  of  drivers  to  "calibrate"  themselves  to  the  vehicle  being  controlled 
and  to,  therefore,  account  for  changes  in  basic  vehicle  dynamics  or  operating  conditions 
(estimation  of  retardation  as  a  function  of  command  pressure;  prediction  of  future  vehicle 
position;  adaptation  to  gross  vehicle  weight  changes).  Secondly,  it  is  assumed  that  the 
simulated  driver  does  not  react  in  an  instantaneous  manner  to  an  elected  brake  control 
strategy.  Consequently,  a  simple  transport  time  delay  property  can  be  assigned  to  the 
driver  to  represent  this  basic  limitation.  The  value  used  for  this  delay  was  0. 1  second  in  the 
calculations  seen  above  (for  a  very  responsive  driver),  but  a  value  more  representative  of 
"average"  drivers  would  probably  be  somewhat  greater  Simulations  performed 

in  reference  45  with  varying  values  of  this  driver  model  time  delay  parameter  suggested  a 
strong  sensitivity  between  closed-loop  stopping  performance  and  this  basic  driver  lag 
property. 
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Brake  Treadle  Pressure 


5-axle  Tr-Semi;  30  mph;  Braking-in-a-Turn;  Driver  Control; 


Figure  5-67.  Command  Pressure  Modulation  by  the  Driver 
Braking  Model  in  Response  to  Front  Axle 
Lock-ups 
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Appendix  A 

Articulated  Vehicle  Equations 


A-l 


As  noted  in  section  5.5  of  the  report,  the  internal  single-unit  model  used  throughout  much 
of  this  report  as  the  "reference"  vehicle  used  by  the  driver  model,  can  also  be  used  for 
steering  many  articulated  vehicles,  provided  the  lead-unit  vehicle  parameters  reflect  the 
presence  of  the  hitch  load  as  described  in  that  section.  The  alternate  approach  for  steering 
an  articulated  vehicle  is  to  apply  a  more  complete  set  of  articulated  vehicle  equations,  such 
as  those  appearing  in  this  appendix,  as  a  substitute  for  the  single-unit  equations  presented 
earlier. 

The  equations  in  this  appendix  apply  to  the  articulated  vehicle  model  shown  in  Figure  A-1 
and  Table  A-1.  This  basic  model  is  intended  to  serve  as  a  "simplified"  articulated  vehicle 
with  front  wheel  steering  and  a  provision  for  an  articulation  control  torque,  patterned  after 
the  LVS  vehicle.  These  equations  would  be  used  to  represent  the  internal  vehicle  model 
employed  by  the  driver  control  algorithm  when  steering  an  articulated  vehicle,  if  a  fuller 
treatment  of  possible  driver/vehicle  interactions  is  required.  The  controlled  system 
dynamics,  now  represented  by  an  articulated  vehicle  having  one  additional  degree  of 
freedom  in  its  simplest  form,  is  extended  beyond  that  of  the  single-unit  vehicle  assumed  by 
the  baseline  driver  model  of  section  5.5. 

A  diagram  of  the  proposed  articulated  vehicle  used  by  the  driver  model  is  seen  in  Figure  A- 
1.  A  list  of  corresponding  variable  and  parameter  definitions  appears  in  Table  A-1.  The 
model  has  two  control  inputs:  the  front  wheel  steer  angle,  5,  and  the  articulation  torque. 
Me.  (A  later  simplification  slaves  the  articulation  control  torque  to  the  front  wheel  steer 
angle  by  a  proportional  gain  factor,  thereby  resulting  in  essentially  one  control  input  and  a 
gain  parameter  for  controlling  the  front-wheel-steer  /  articulation-torque  "mixture.")  The 
linearized  equations  representing  the  articulated  vehicle  model  now  follow. 

The  sum  of  lateral  forces  and  sum  of  yaw  torques  acting  on  each  of  the  two  articulated 
masses  produces  the  following  four  dynamical  equations  (primes  denoting  differentiation 
with  respect  to  time): 


mi  vi' 

+ 

II 

Fy2  -  mi  U  ri 

(fy 

Iin*  = 

aiFyi  - 

bi  Fy2  - 

Cl  fy 

m2  V2' 

=  Fy2  - 

m2Ur2  - 

fy 

I2r2’  = 

-b2Fy3 

-  C2fy  - 

Me 

fy  (A-1) 

is  the  lateral  hitch  constraint  force) 
+  Me  (A-2) 

(A-3) 

(A-4) 
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Table  A-1.  Articulated  Vehicle  Model  -  Parameter  Definitions 


Parameter 

m1 

m2 

v1 

v2 

r1 

r2 

a1 

b1 

b2 

c1 

c2 

U 

5 

Y 

a\ 

Cj 

Me 


(Internal  Driver  Model  Representation) 

Description 

mass  of  front  unit 

mass  of  rear  unit 

lateral  sideslip  velocity  of  unit  1 

lateral  sideslip  velocity  of  unit  2 

yaw  rate  of  unit  1 

yaw  rate  of  unit  2 

distance  form  c.g.  of  unit  1  to  axle  1 
distance  form  c.g.  of  unit  1  to  axle  2 
distance  form  c.g.  of  unit  2  to  axle  3 
distance  form  c.g.  of  unit  1  to  hitch 
distance  form  c.g.  of  unit  2  to  hitch 
fonward  velocity  component  in  x-body  axis 
front  axle  steer  angle  -  control  variable 

articulation  angle 
tire  sideslip  angle  (axle  i) 

tire  cornering  stiffness  (axle  I) 
articulation  torque  -  control  variable 
lateral  tire  force  (axle  I) 


I 
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The  kinematic  constraint  for  the  articulation  joint  produces  the  following  algebraic 
relationship  between  the  lateral  displacement,  yi,  and  heading  angle  variables,  \|/i : 


yi  -  Cl  sin  =  y2  +  C2  sin  \|/2  (A-5) 

Differentiating  twice  and  assuming  small  angles  for  the  heading  angles  results  in  the 
equivalent  constraint  equation  expressed  in  terms  of  the  associated  accelerations: 

vi'  +  U  ri  -  Cl  ri'  =  V2'  +  U  r2  +  C2  r2'  (A-6) 

The  tire  forces  Fyi  can  be  expressed  in  terms  of  the  tire  cornering  stiffnesses  and  tire 


sideslip  angles  as: 

Fyi  —  -  Coi  otj 

(A-7) 

where. 

ai  =  tan-l[  (vi  +  ai  ri)  /  U  ]  -  5 

(A-8) 

a2  =  tan-l[(vi  -  biri)/U] 

(A-9) 

as  =  tan-l[(v2  -  b2r2)/U] 

(A-10) 

Assuming  small  tire  sideslip  angles  for  the  aj  (replacing  the  arctan  by  the  angle). 
Equations  (A-1)  ->  (A-4)  become  after  these  substitutions: 


mi  vi'  =  -  Cal  (vi+airi)  /  U  -  Ca2  (vi-biri)  /  U  +  Cai  5  -  mi  U  ri  +  fy  (A-1 1) 

Iiri'  =  -aiCai(vi+airi)/U  +  biCa2(vi-biri)/U-cify  +  aiCai5  +  Mc  (A-12) 
m2  V2’  =  -  Ca3  (v2-b2r2)  /  U  -  m2  U  r2  -  fy  (A- 13) 

I2r2'  =  b2  Ca3  (v2-b2r2)  /  U  -C2fy  -  Me  (A-l4) 


Expressed  in  matrix  algebra  terminology,  the  equations  of  motion  (A-11)  ->  (A- 14) 
become: 

Mv’  =  Av  +  G5  +  Nfy  +EMc  (A-15) 
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and  the  kinematic  constraint  equation  (A-6)  becomes: 

C  v'  =  D  V  (A-16) 

where,  v  =  {  vi,  ri,  V2,  r2  }T  . 

Solving  (A-15)  and  (A-16)  for  the  constraint  force,  fy,  and  upon  back  substitution,  results 
in  the  following  set  of  dynamical  equations  free  of  the  constraint  force: 

v'  =  F*v  +  g*5  +  hMc  (A- 17) 

For  a  powered  articulation  scheme  with  Me  =  K  [  5  -  T|  (\|/i  -\|r2)  ] ,  where  the  parameter 
K  controls  the  degree  to  which  the  articulation  torque  is  slaved  to  the  front  wheel  steer 
angle,  5,  and  ti  provides  an  optional  torsional  spring  effect  about  the  articulation  joint, 
equations  (A- 17)  become: 

v'  =  F*v  +  (g*  +  Kh)5  +  Yi  terms  (A-18) 

Addition  of  the  lead  unit  lateral  displacement,  yi,  and  heading  angle  state  variable,  \|ri, 
equations,  results  in  the  final  set  of  seven  linear  dynamical  equations: 
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or  in  matrix  algebra  notation: 


{X’}7xl  =  [F]7x7  {X}7x1  +  {g}7xl  5ixl  (A-20) 


where. 


-(Cal+Ca2)AJ 

(-aiCai+biCa2)/U 

0 
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(-Caiai+Ca2bi)AJ-miU 

-(Caiai2+Ca2bi2)AJ 

0 

0 


0 

0 

-Ca3/U 

baCasAJ 


0 

0 

b2Ca3AJ-m2U 

-Ca3b22/U 


c  =  {  1,  -Cl.  -1.  -C2  } 
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D 


{  0, 


-u.  0.  U  } 


and, 


F*  = 

M-1  (  A  +  N  [  C  M-1  N  ]-l  ( D  -  C  M-1  A  ) ) 

(A-21) 

g*  = 

M-1  ( G  -  N  [  C  M-1  N  ]-l  C  M-1  G  ) 

(A-22) 

h 

M-1  ( E  -  N  [  C  M-1  N  ]-l  C  M-1  E  ) 

(A-23) 

To  use  these  equations  in  the  driver  model,  the  F  and  g  matrices  appearing  in  Equation  (A- 
20)  would  replace  the  corresponding  F  and  g  matrices  presented  earlier  in  section  5.4,  to 
now  represent  the  internal  vehicle  dynamics  within  the  driver  model. 

As  indicated  above,  the  LVS  vehicle  was  used  as  a  guide  for  defining  the  characteristics  of 
the  articulated  model.  General  estimates  of  the  LVS  mass  and  geometric  parameters  are 
listed  in  Table  A-2.  These  parameters  were  used  in  an  example  calculation  demonstrating 
the  operation  of  the  equations  just  presented  for  steering  an  LVS-like  articulated  vehicle. 

Example  time  histories  are  seen  in  Figure  A-2  for  the  simulated  LVS  articulated  vehicle, 
controlled  by  the  extended  driver  model,  performing  a  12-foot  lane-change  maneuver  at  60 
mph.  The  input  path  was  a  standard  12-ft  by  100-ft  lane-change.  The  first  four  plots 
correspond  to  the  lead  unit  The  second  four  plots  apply  to  the  trailing  unit.  The  last  group 
of  time  histories  show  lateral  acceleration  traces  for  the  lead  and  trailing  units,  the  control 
variable  (degrees  of  fi'ont  wheel  angle),  and  the  calculated  mean  squared  path  error  within 
the  preview  interval  "MSE  Preview  Path  Error."  In  this  particular  example,  the  articulation 
control  torque  was  active  and  was  slaved  to  the  front  wheel  steer  angle  (10,000  ft-lb  of 
articulation  control  torque  /  degree  of  front  steer  angle).  The  results  seen  here  were 
calculated  with  a  modified  UMTRI  vehicle  model  (to  incorporate  the  articulation  control 
torque)  and  used  the  extended  driver  model  equations  from  this  Appendix. 
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Table  A-2.  LVS  Parameter  Estimates 


Parameter 


Value 


ml 

m2 

11 

12 
al 
bl 
cl 
b2 
c2 
U 
Cl 

C2 

C3 

TF 

Tau 

RKMOM 


750  slugs 
515  slugs 

9,000  ft^-slug  (lead  unit  yaw  inertia) 

20,000  (rear  unit  "  "  ) 

2.5  ft 

2.5  ft 
5.3  ft 
2.0  ft 
14.25  ft 
88  ft/sec 

42,000  Ib/rad/suspension-side  (tire  cornering 

stiffness) 

68,000 

62,000 

1.5  sec  (driver  preview  time) 

0.25  sec  (driver  transport  lag) 

570,000  ft-lb/rad  (articulation  control 

moment-front  steer  gain) 
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Figure  A-2.  Example  Calculations  for  a  Simulated  LVS 
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Figure  A<2.  Example  Calculations  for  a  Simulated  LVS 
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Figure  A-2.  Example  Calculations  for  a  Simulated  LVS 
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Appendix  B 
HMMWV  Test  Data 
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The  material  contained  in  this  Appendix  supplements  the  test  data  appearing  in  earlier 
sections  of  the  report  and  helps  document  the  types  of  test  maneuvers  performed.  Example 
time  histories  are  provided  here  for  each  test  maneuver  conducted  during  the  test  program. 
The  complete  set  of  data  collected  during  the  project  are  being  supplied  to  TACOM  on 
floppy  disks  with  corresponding  UMTRI  software  used  to  graphically  view  the  time 
history  data.  Log  sheets  for  all  of  the  test  data  collected  during  the  test  program  appear  in 
Table  5-2  of  section  5.6. 

The  first  set  of  Figures  B-1  to  B-4  apply  to  the  steady  turning  maneuver  performed  at  50 
and  25  mph  respectively  (tests  105  and  110  from  Table  5-2).  Measurements  of  forward 
speed,  driver  steering  wheel  angle,  and  lateral  acceleration  are  seen  in  Figures  B-1  and  B-3. 
Figures  B-2  and  B-4  show  corresponding  measurements  of  roll  angle,  yaw  rate,  and  left 
front  wheel  angle.  The  "spikes"  seen  in  the  roll  angle  measurement  data  are  due  to  faulty 
contacts  occuring  within  the  roll  angle  transducer  wiper  assembly.  Irregular  drifting  of  the 
roll  angle  measurement  was  also  encountered  with  this  same  transducer.  For  most  of  the 
tests  performed  in  this  study,  this  particular  measurement  was  of  secondary  importance  and 
is  only  shown  here  to  provide  a  "ballpark"  estimate  of  the  vehicle  roll  response. 

Figures  B-5  to  B-8  show  example  test  results  from  the  braking-in-a-tum  maneuver  from  an 
initial  speed  of  50  mph  and  along  a  curve  of  500-ft  radius.  Figures  B-5  and  B-6 
correspond  to  a  short  stopping  distance  of  132  ft  (test  118);  Figures  B-7  and  B-8  show 
comparable  results  for  a  longer  stopping  distance  of  195  ft  (test  120).  Driver  brake 
pressure,  longitudinal  acceleration,  and  forward  speed  are  seen  in  Figures  B-5  and  B-7. 
Figure  B-6  and  B-8  show  the  corresponding  driver  steering  wheel  angle  and  lateral 
acceleration  measurements. 

Example  results  from  the  constrained  lane-change  maneuver  at  60  and  30  mph  are  seen  in 
Figures  B-9  through  B-12.  The  60  mph  results  are  from  test  127;  the  30  mph  results  are 
from  test  137. 

Two  example  runs  from  the  obstacle  course  tests  are  seen  in  Figure  B-13  to  B-16.  The 
first  example,  seen  in  Figures  B-13  and  B-14,  are  from  test  184  and  correspond  to  a 
"short/short"  obstacle  placement  (L=80  ft;  L2=100;  L3=120  ft)  as  discussed  in  section 
5.6.  Figures  B-1 5  and  B-16  are  from  run  185  and  correspond  to  a  "long/long"  obstacle 
placement  (Ll=120  ft;  L2=100;  L3=80  ft).  The  previous  results  seen  for  the  obstacle 
course  in  section  5.7  were  for  a  "center/center"  setting  of  the  two  obstacles. 

Figures  B-17  to  B-19  correspond  to  three  different  straight-line  braking  tests  (213,  215, 
and  214).  Figure  B-17  is  for  a  relatively  long  stopping  distance  showing  the  driver  clearly 
modulating  the  brake  pressure  about  an  approximate  value  of  350  psi.  Figure  B-1 8  is  for  a 
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realtively  short  stopping  distance  of  145  ft  The  driver  brake  pressure  application  is 
considerably  larger  and  noticeably  different  ii  feet,  diis  particular  trace  closely  resembles 
the  shape  of  the  time  history  prediction  from  the  closed-loop  braking  model  seen  in  Figure 
5-65.  The  last  straight-line  braking  test  result  scai  in  Figme  B-19  is  for  a  stopping 
distance  of  125  ft  but  included  wheel  lock  occmences  at  both  the  front  and  rear  axles. 
Midway  through  this  stop,  the  driver  is  seen  releasing  die  brake  pressure  temporarily  to 
regain  directional  control  of  the  vehicle.  Sharp  stewing  to  the  right  by  the  driver  is  also 
seen  at  the  7-second  mark  in  response  to  the  directional  disturbance  to  the  vehicle  motion 
caused  by  the  wheel  locks. 

Lastly,  Figure  B-20  shows  a  sample  result  from  a  "Random  Steer  Test"  initially  conducted 
to  obtain  open-loop  frequency  response  characteristics  on  the  HMMWV  directional 
dynamics.  These  were  subsequently  not  needed  but  are  available  for  future  studies  as  part 
of  the  HMMWV  test  data  library  being  delivered  to  TACOM.  A  typical  random  steer  test 
would  last  from  45  to  75  seconds  depending  upon  the  test  speed.  Shown  in  Figure  B-20 
are  the  first  20  seconds  from  test  202  conducted  at  60  mph.  The  driver  is  simply  applying 
a  "random-like"  steering  input  to  the  vehicle  while  travelling  along  a  straight-line  course. 
The  intent  of  this  test  is  to  excite  the  directional  dynamics  with  a  wide  variety  of  steering 
frequencies,  thereby  allowing  a  subsequent  Fourier  analysis  to  be  applied  to  the  recorded 
data.  The  Fourier  analysis  then  produces  the  frequency  response  of  the  vehicle  directional 
dynamics  due  to  the  steering  input 
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Figure  B-1.  HMMWV  Test;  50  mph  Steady  Turn 
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Figure  B-2.  HMMWV  Test:  50  mph  Steady  Turn 
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Figure  B-3.  HMMWV  Test:  ^5  mph  Steady  Turn 
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Figure  B-4.  HMMWV  Test:  25  mph  Steady  Turn 
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Figure  B-5.  HMMWV  Test:  Braking-in-a-Turn,  132  ft 
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Figure  B-6.  HMMWV  Test:  Braking-in-a-Turn,  132  ft 
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Figure  B-7.  HMMWV  Test:  Braking-in-a-Turn,  195  ft 
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Figure  B-8.  HMMWV  Test:  Braking-in-a-Turn,  195  ft 
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Figure  B-9.  HMMWV  Test:  Lane-Change,  60  mph 
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Figure  B-10.  HMMWV  Test:  Lane-Change,  60  mph 
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Figure  B-11.  HMMWV  Test:  Lane-Change,  30  mph 
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Figure  B-12.  HMMWV  Test:  Lane-Change,  30  mph 
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Figure  B-13.  HMMWV  Test:  Obstacle  Course,  short/short 
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Figure  B-14.  HMMWV  Test:  Obstacle  Course,  short/short 
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Figure  B-15.  HMMWV  Test:  Obstacle  Course,  iong/long 
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Figure  B-16.  HMMWV  Test:  Obstacfe  Course,  long/long 
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Figure  B-17.  HMMWV  Test:  Straight-Line  Braking,  200  ft 
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Figure  B-18.  HMMWV  Test:  Straight-Line  Braking,  145  ft 
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Figure  B-19.  HMMWV  Test:  Straight-Line  Braking,  125  ft 
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Figure  B-20.  HMMWV  Tei*.  Random  Steer  Application 
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Appendix  C 

HMMWV-Trailer  Test  Data 
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The  test  data  appearing  in  this  appendix  are  for  the  combined  HMMWV-Trailer  vehicle 
tests.  Mousseau,  in  reference  41,  utilized  these  data  in  validating  a  DADS  computer  model 
of  the  HMMWV-Trailer  combination  and  in  furtha:  studying  the  dynamic  response  of  that 
system.  The  log  sheets  appearing  as  Table  5-2  in  section  5.6  list  these  data  as  tests  271- 
310.  During  this  sequence  of  tests,  the  trailer  payload  of  approximately  1600  lb  was 
located  directly  over  the  trailer  axle.  This  loading  resulted  in  a  vertical  hitch  load  of  176  lb 
on  the  HMMWW^.  Three  different  types  of  handling  tests  were  conducted  for  the 
combination  vehicle  and  an  example  of  each  appears  in  Hgures  C-1  through  C-8. 

Figures  C-1  to  C-3  correspond  to  a  nominal  50  mph  lane-change  maneuver  (test  281).  The 
first  two  figures,  C-1  and  C-2,  apply  to  the  lead  unit  (HMMWV).  Figure  C-3  shows  the 
HMMWV-trailer  articulation  angle  and  the  lateral  acceleration  experienced  by  the  trailer. 
The  trailer  lateral  accelerometer  was  body-mounted  (as  opposed  to  the  stable  platform 
mounting  in  the  HMMWV).  Consequently,  its  measurement  includes  a  small  component  of 
gravity  due  to  trailer  roll  angle  which  should  be  accounted  for  in  any  subsequent  analyses. 

Figures  C-4  and  C-5  show  measured  results  from  steady  turning  test  296. 

The  data  seen  in  Figures  C-6  through  C-8  are  from  the  braking-in-a-tum  test  308. 

A  sequence  of  additional  HMMWV-Trailer  tests  having  unusual  (fore/aft)  trailer  loadings 
are  listed  as  tests  320-348  in  Table  5-2.  During  these  tests,  the  same  1600  lb  trailer 
payload  as  used  in  the  previous  test  series  was  moved  either  (a)  all  the  way  forward  in  the 
trailer  ("Divergence  Tests"  320-335),  or,  (b)  all  the  way  rearward  (Oscillation  Tests"  336- 
348).  These  tests  were  part  of  a  special  trailer  stability  study  reported  on  in  reference  42  by 
Stribersky,  and  were  intended  to  help  validate  the  application  of  "bifurcation"  theory  to 
non-linear  vehicle  systems.  That  reference  is  included  as  part  of  Appendix  G. 

An  example  divergence  test  is  seen  in  Figure  C-9.  In  general,  these  tests  proved  to  be 
largely  uneventful,  with  the  test  driver  having  no  dificulty  in  maintaining  directional  stablity 
of  the  vehicle. 

Two  examples  of  the  trailer  oscillation  tests  are  seen  in  Figures  C-10  through  C-13. 
Figures  C-10  and  C-11  correspond  to  test  342  showing  the  response  of  the  combination 
vehicle  to  a  sinusoidal-like  steering  wheel  disturbance  applied  by  the  driver  in  order  to 
excite  the  system.  Following  this  initial  steering  input,  the  driver  only  attempted  to  stabilize 
the  lead  HMMWV  unit  along  a  straight-line  path.  The  resulting  vehicle  oscillations  that 
build  up  due  to  the  adverse  rearward  loading  of  the  trailer  are  clearly  seen  in  the 
accompanying  figures.  Figures  C-12  and  C-13  correspond  to  test  343  in  which  the  same 
test  was  repeated  but  with  a  larger  initial  steering  wheel  input.  In  both  of  these  tests,  the 
loss  of  forward  speed  during  the  tests  helps  to  eventually  damp  out  the  limit  cycle 
oscillations  that  are  initially  excited  by  the  steering  inputs. 
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Figure  C-1.  HMMWV  /  Trailer  Lane-Change  Test 
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Figure  C-2.  HMMWV  /  Trailer  Lane-Change  Test 
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Figure  C-3.  HMMWV  /  Trailer  Lane-Change  Test 


C-6 


Forward  Velocity  -  mph 


0  5  10  15 

time  -  sec 

07/08/88  1627:43  STEADY  TURNING  42MPH 
Driver  Steering  Wheel  Angle  >  deg 


0  5  10  15 

time -sec 

07/08/88 1627:43  STEADY  TURNING  42MPH 


0  5  10  15 


time -sec 

07/08/88  1627:43  STEADYTURNING  42MPH 

Figure  C-4.  HMMWV  /  Trailer  Steady  Turning  Test 
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Figure  C-5.  HMMWV  /  Trailer  Steady  Turning  Test 
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Figure  C-6.  HMMWV  /  Trailer  Braking-in-a-Turn  Test 
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Figure  C-7.  HMMWV  /  Trailer  Braking-in-a-Turn  Test 
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Figure  C-9.  HMMWV  /  Trailer  "Divergence"  Test 
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Figure  C-10.  HMMWV  /  Trailer  ''Oscillation”  Test 
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Figure  C-11.  HMMWV  /  Trailer  "Oscillation" 
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Figure  C-12.  HMMWV  /  Trailer  "Oscillation"  Test 
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Figure  C-13.  HMMWV  /  Trailer  "Oscillation" 
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FORTRAN  Driver  Model  Code 
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This  appendix  contains  FORTRAN  code  defining  the  basic  single-unit  driver  steering 
control  model  interfaced  to  the  CADSI  /  DADS  program  used  at  TACOM.  Other  DADS 
subroutines  such  as  USER49,  TTREF,  and  FILTER  that  were  used  to  call  the  driver  model 
or  calculate  information  for  the  model  are  contained  in  Appendix  E. 

The  following  subroutine  are  listed  in  this  appendix: 

called  once  by  DADS  at  time  zero 
called  by  DADS  for  reporting  out 
caUedbyDRIVGO 
called  by  DRIVGO  &  DRIVER 
called  by  USER49  (DADS)  each  time  step 
called  by  DRIVER 
called  by  DRIVER 


•  DRIVGO 

•  OUT  (optional) 

•  DRIVEl 

•  TRANS 

•  DRIVER 

•  TRAJ 

•  GMPRD 
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C  The  following  FORTRAN  code  documents  the  basic  driver  model 
C  stibroutines  used  with  the  DADS  program  to  simulate  a  closed-loop 
C  vehicle-driver  system.  Most  portions  of  this  code,  not  specific  to 
C  DADS,  may  be  used  to  represent  the  driver  model  within  other  vehicle 
C  simulation  programs.  The  code  listed  here  utilizes  a  2-DOF  vehicle 
C  model  for  the  driver's  internal  vehicle  representation. 

C 

C 

Q*^**^****^^^**********^**************T*r^***’****^***^^******^************ 

***  DADS3D  Initialization  Entry  for  the  Driver  Model  *** 

DRTVGO:  Intializes  driver  model  variables  and  opens  driver  model 
files 

. ---■  . == . -^Aiithor  and  Modification  Section— 

Author:  C.  C.  MacAdam 

Date  written:  01/01/88 
Written  on: 

Modifications : 


. 'Algorithm  Descript ion==  . .  . . .  . . ,-,„n;r= - ^ = 

Purpose  and  use: 

Error  conditions: 

References : 

[1]  MacAdam,  C.C.  "Development  of  Driver /Vehicle  Steering 

Interaction  Models  for  Dynamic  Analysis, "  Final 
Technical  Report,  U.S.  Army  Tank  Automotive  Command 
Contract  No.  DAAE07-85-C-R069,  The  University  of 
Michigan  Transportat ' n  Research  Inst,  December  1988 

[2]  MacAdam,  C.C.  "Application  of  an  Optimal  Preview  Control 

for  Simulation  of  Closed-Loop  Automobile  Driving, " 
IEEE  Transactions  on  Systems,  Man,  and  Cybernetics, 
Vol.  11,  June  1981. 

[3]  MacAdam,  C.C.  "An  Optimal  Preview  Control  for  Linear 

Systems, "  Journal  of  Dynamic  Systems,  Measurement, 
and  Control,  ASME,  Vol.  102,  No.  3,  September  1980. 


Machine  dependencies :  none 
Called  By:  USER49.F77 
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SUBROUTINE  DRIVGO 

. . Vcirlable  Descriptions^^  . = . irviTiT^.  . -- . . ■■■=Tr:v:T';=Br3a;s;==='=-v 

— Arguments  passed:  None 
INTEGER  R,  W 

— COMMON  blocks - 

COMMON  /DRTV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE/DRIV/ 

CCM40N  /INOUT/  R,  W 
SAVE/INOUT/ 

— COMMON  Variables - 

R . Driver  Model  Input  I/O  unit  ("DMINPUT.INP”)  -  optional 

W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT")  -  optional 

— DRXV.BLK  common  block  variables— - 

CAF... total  cornering  stiffness  of  tires  on  left  front  susp  (Ib/rad) 
CAR. .  .total  cornering  stiffness  of  tires  on  left  reair  susp  (Ib/rad) 
WHBS. .wheelbase  of  vehicle  (center-line  of  front  &  rear  susp)  (ft) 

WF . . . . static  load  on  front  suspension  (lb) 

WR. ...static  load  on  rear  suspension  (lb) 

U . initial  velocity  (ft/sec) 

— Local  variables - 

A . distcince  from  c.g.  to  front  suspension  center-line  (ft) 

B . distance  from  c.g.  to  rear  suspension  center-line  (ft) 

WGHT. .total  static  weight  on  front  and  rear  suspsensions  (lb) 

RM. . . .total  static  mass  (slug) 

DFW. ..steer  angle  of  front  tires  [or  average]  (rad) 

— Functions  and  subroutines - 

EXTERNAL  DRIVEl,  TRANS 


=Process  Block= 


R=33 

W=34 

GRAY  =  32.16666 

OPEN  (R, FILE= ' DMINPUT . INP ' , STATUS= ' UNKNOWN ' ) 

OPEN  (  W,  FILE= 'DMOUTPUT. OUT ',STATUS=' UNKNOWN') 

Driver  model  internal  vehicle  model  parameters  can  be  read  in  from 
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C  external  files,  as  here,  or  passed  from  DADS  through  common  blocks 
C 

READ  (R,10)  CAF,  CAR,  WGHT,  U,  A,  B,  RI 

10  FORMAT  (7F10.3) 

11  FORMAT (3F10. 3) 

C 

RM  =  WGHT  /  GRAY 
WHBS  =  A  +  B 
WF  =  WGHT  *  B  /  WHBS 
WR  =  WGHT  *  A  /  WHBS 
C 

C  Call  DRTYEl  to  read  driver  model  parameters  &  initialize 
C 

CALL  DRIVEl(DFW) 

C 

C  Call  TRANS  to  Calculate  Transition  Matrix  at  time  zero 
C  - 

CALL  TRANS 


C 

RETURN 

END 


C 

C  ***  Out  Subroutine  ***  ***  OPTIONAL  SUBROUTINE  *** 

C 

C  OUT:  Writes  driver  model  calculations  on  unit  W 
C 

C=:  =' = . . . ==== . Author  and  Modification  Section^  . =•■=  . -  — . ====== . ■==  -  - 

C 

C  Author:  C.  C.  MacAdam 

C 

C  Date  written:  01/01/88 
C 

C  Written  on: 

C 

C  Modifications : 

C 


C 

C---"= . —  Algorithm  Description= 

C 

C  Purpose  and  use: 

C 

C  Error  conditions : 

Machine  dependencies :  none 
Called  By:  DRTVGO 


SUBROUTINE  OUT(T,  Y,  YD,  DFW) 

===== . Variable  Descriptions=== 
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— Arguments  passed: 

T . current  time  in  simulation  (sec) 

Y . driver  model  state  vector  of  dimension  5  comprised  of  the 

following  physical  quantities:  [1]  inertial  lateral 
displacement  (ft),  [2]  lateral  veloc  in  body  frame  (ft/s), 
[3]  yaw  rate  global  (rad/s),  [4]  SAE  global  yaw  angle  (rad), 
[5]  global  forward  displacent  (ft) . 

YD ... . rates  of  change  of  Y 

DFW. ..steer  angle  of  front  tires  [or  average]  (rad) 

INTEGER  R,  W 

DIMENSION  Y( 5),  YD (5),  YOUT(5),  YDOUT(5) 

— COMMON  blocks - 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE/DRIV/ 

COMMON  /INOUT/  R,  W 
SAVE/INOUT/ 

— COMMON  Variables—^ - - - 

R . Driver  Model  Input  I/O  iinit  ("DMINPUT.INP") 

W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT") 

— DRIV.BLK  common  block  variables - 


CAF... total  cornering  stiffness  of  tires  on  left  front  susp  (Ib/rad) 
CAR.  ..total  cornering  stiffness  of  tires  on  left  rear  susp  (Ib/rad) 
WHBS. .wheelbase  of  vehicle  (center-line  of  front  &  rear  susp)  (ft) 

WF . . . . static  load  on  front  suspension  (lb) 

WR.  ...static  load  on  reair  suspension  (lb) 

U . initial  velocity  (ft/sec) 

— Local  vciriables - - - 

YOUT. .. .output  buffer  in  engineering  /  english  units  for  Y  vector 
YDOUT. . .  "  "  YD  " 

DFWPRT. . Steer  angle  in  degrees 

RADIAN. .radian  to  degree  conversion  factor  (deg/ rad) 

— "Functions  and  subroutines - 

None 


"Process  Block" 


C 


DATA  RADIAN  /57.3/ 
DO  10  I  =  1,  5 


D-7 


ooooooo  oooooooooooooooononoooonooooo 


YOUT(I)  =  Y(I) 

YDOUT(I)  =  YD  (I) 

10  CONTINUE 

YOUT(2)  =  Y(2)  /  U  *  RADIAN 
YOUT(3)  =  Y(3)  *  RADIAN 
YOUT(4)  =  Y(4)  *  RADIAN 
YDOUT(2)  =  YD(2)  /  U  *  RADIAN 
YDOUT(3)  =  YD(3)  *  57.3 
YDOUT(4)  =  YD (4)  *  RADIAN 
DFWPRT  =  DFW  *  RADIAN 

WRITE  (W,20)  T,  DFWPRT,  (YOUT (I) , 1=1, 5) ,  (YDOUT (I) , 1=1, 5) 
20  FORMAT  (12F8.2) 

RETURN 

END 


***  Initialization  Subroutine  *** 

DRTVEl:  Intializes  variables  and  echoes  driver  model  parameters  on  W 

’ . == . . - . -^Author  and  Modification  Section~=  . =•== . ' . :-T=;.i.::===i:;.::====-,.r== 

Author;  C.  C,  MacAdam 

Date  written:  01/01/88 
Written  on; 

Modifications : 


=====Algorithm  Description= 
Purpose  and  use: 

Error  conditions: 

Machine  dependencies;  none 
Called  By:  DRIVGO 


SUBROUTINE  DRIVEl (DFW) 

— . . .  "Variable  Descrlptions=-  . ■—  ■:-====";==:==  ' 

— Arguments  passed: 

DFW. ..steer  angle  of  front  tires  [or  average]  (rad) 

INTEGER  R,  W 
C 
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C - CCadMON  blocks - 

c 

COMMON  /DRVSTl/  GPAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  BM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(1000,2),  XT (100),  YT(IOO) 

SAVE/DRVSTl/ 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE/DRIV/ 

CCM^ION  /INOUT/  R,  W 
SAVE/INOUT/ 

C 

C - COMMON  Variables - - - 


C  R . Driver  Model  Input  I/O  unit  ("DMINPUT.INP") 

C  W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT") 

C 


C - DRTV.BLK  common  block  variables - - - 

C 

C  CAF... total  cornering  stiffness  of  tires  on  left  front  susp  (Ib/rad) 
C  CAR. . .total  cornering  stiffness  of  tires  on  left  rear  susp  (Ib/rad) 

C  WHBS. .wheelbase  of  vehicle  (center-line  of  front  &  rear  susp)  (ft) 

C  WF.... static  load  on  front  suspension  (lb) 

C  WR. ...static  load  on  rear  suspension  (lb) 

C  U . initial  velocity  (ft/sec) 

C 

C - DRVSTl. BLK  common  block  variables 

C 

C  GRAV . gravitational  constant 

C  TICYCL. . .driver  model  sample  time  (sec) 

C  TSS . minimum  preview  time  (sec) 

C  DMAX . upper  bound  on  front  wheel  angle  steer  (rad) 

C  XP,YP....x-y  path  coords (SAE)  wrt  inertial  coords  [input]  (ft) 

C  TAUMEM. . .driver  transport  time  dealy  [input  parameter]  (sec) 


C  TFF . driver  model  preview  time  [input  parameter]  (sec) 

C  RM . vehicle  mass  (slug) 

C  A . distance  from  c.g.  to  front  suspension  center-line  (ft) 

C  B . distance  from  c.g.  to  recu:  suspension  center-line  (ft) 

C  RI . total  vehicle  yaw  inertia  (slug-ft) 

C  PSIO . current  yaw  angle  reference  value  (rad) 

C  NTF . nxmiber  of  points  in  the  preview  time  interval 

C  NP . number  of  points  in  the  x-y  trajectory  table 

C  TLAST. .. .last  time  driver  model  calulated  a  steer  value  (sec) 

C  DFWLST. . .last  value  of  steer  calculated  by  driver  model  (rad) 

C  TILAST. . .last  sample  time  driver  model  calulated  a  steer  value  (sec) 

C  DMEM . 2-dim  array  (time  &  steer  history)  used  in  delay  calculat'n 

C  XT, YT. .. .transformation  of  XP,YP  in  vehicle  body  axes  (ft) 

C 


C - Local  variables - 

C 

C  WGHT.. total  static  weight  on  front  amd  rear  suspsensions  (lb) 
C  DFW... steer  angle  of  front  tires  [or  average]  (rad) 

C 

C - Functions  and  subroutines - 

C 

C  None 
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=Process  Block= 


GRAY  =  32.16666 
TICYCL  =  0.000001 
TSS  =  0.0 
DMAX  =0.2 

Read  &  Echo  Driver  Model  Path,  Time  Delay,  and  Preview  Parameters 
-  OPTIONAL.  May  be  passed  instead  from  DADS  through  common  blocks 
and  echoed  as  part  of  DADS  standard  I/O 


WRITE  (W,10) 
10  FORMAT  ('O', 

1  'X-Y 

2  'Y', 


T20,  ' CLOSED-LOOP  PATH  FOLLOWING  MODE ' ,  /,  'O',  T20, 


',  'PATH',  '  COORDINATES  :', 
/,  /'O',  T47,  '(FEET)',  T57, 


/,  'O',  T50, 
(FEET) ' ) 


T60, 


READ  (R,20)  NP 
20  FORMAT  (13) 

DO  40  J  =  1,  NP 

READ  (R,30)  XP(J),  YP ( J) 
30  FORMAT  (2F10.2) 

WRITE  (W,  50)  XP(J),  YP(J) 
40  CONTINUE 

50  FORMAT  ('  ',  T43,  2F10.2) 
READ  (R,  60)  TAUMEM,  TFF 


FORMAT 

(FIO. 

4) 

WRITE 

(W,70) 

TAUMEM, 

TFF 

FORMAT 

(’ 

/  9  9 

T20 

F4.2, 

/  »  • 

9  9  9 

T20 

'DRIVER  TRANSPORT  LAG  (SEC)  : ' 
'END  OF  PREVIEW  INTERVAL  (SEC) 


T60, 

T60, 


F4.2/) 


RM  =  (WF  +  WR)  /  GRAY 
B  =  WHBS  *  WF  /  (WF  +  WR) 
A  =  WHBS  -  B 
RI  =  A  *  B  *  RM 
PSIO  =0.0 
NTF  =  10 
DO  80  J  =  1,  NP 
XT(J)  =  XP(J) 

YT(J)  =  -XP(J)  * 

80  CONTINUE 
TLAST  =  0. 

DFWLST  =  0. 

TILAST  =  0. 

DFW  =  0. 

DO  90  I  =  1,  1000 
DMEM(I,1)  =  0. 

90  DMEM(I,2)  =  -1. 

RETURN 
END 


*  COS (PSIO)  +  YP(J)  *  SIN (PSIO) 
SIN  (PSIO)  +  YP(J)  *  COS  (PSIO) 
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***  Tramsltlon  Ma-bxix  Calcula'tloxi  Subroutine  *** 


TRANS:  Computes  trainsition  matrix  (and  integral)  of  the  linearized 
system,  F,  described  in  references.  Result  stored  in  common 
arrays  TTT  and  TTTl  repectively.  10  pts  per  preview  interval. 

-  — Author  and  Modification  Section==  . ---=  . . .  . . 

Author:  C.  C.  MacAdam 

Date  written:  01/01/88 

Written  on: 

Modifications : 


■  . -=-  =Algorithm  Description=-—  . . . . . ’  . . .  . •-■== 

Purpose  and  use:  Used  by  the  driver  model  in  predicting  future  states 
Error  conditions: 

Machine  dependencies:  none 
Called  By:  DRIVGO 


SUBROUTINE  TRANS 


. . . Variable  Descriptions- 

— Arguments  passed:  None 


INTEGER  R,  W 

DIMENSION  SV(4),  SD(4),  SVI{4) 

— ^COMMON  blocks - 

COMMON  /DRVSTl/  GRAY,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  RM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(1000,2),  XT (100),  YT(IOO) 

SAVE/DRVSTl/ 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE/DRTV/ 

COMMON  /INOUT/  R,  W 
SAVE/INOUT/ 

COMMON  /TRSSTR/  TTT (4, 4, 10),  TTTl (4, 4, 10) ,  G(4) 

SAVE/TRSSTR/ 
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C  Control  Coefficients  A,  B,  C,  D  defined  in  section  5.5  of 
C  reference  [1]  and  passed  from  DADS  through  common  block  VEHTYP 
C  (  A  =1  1,  C=l;  B  =  D  =  k  =  0  defines  a  conventional  front  steer 
C  vehicle,  etc.  ) 

C 

COMMON  /VEHTYP/  AAA,  BBB,  CCC,  DDD,  RATIO 
SAVE /VEHTYP/ 

C 

C - COMMON  Variables - 


C  R . Driver  Model  Input  I/O  unit  ("DMINPUT.INP") 

C  W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT") 

C 


C - DRIV.BLK  common  block  variables - 

C 

C  CAP.. .total  cornering  stiffness  of  tires  on  left  front  susp  (Ib/rad) 
C  CAR. ..total  cornering  stiffness  of  tires  on  left  rear  susp  (Ib/rad) 

C  WHBS. .wheelbase  of  vehicle  (center-line  of  front  &  rear  susp)  (ft) 

C  WF.... static  load  on  front  suspension  (lb) 

C  WR. . . . static  load  on  rear  suspension  (lb) 

C  U . initial  velocity  (ft/sec) 

C 

C - DRVSTl.BLK  common  block  variables 

C 

C  GRAV . gravitational  constant 

C  TICYCL. . .driver  model  sample  time  (sec) 

C  TSS . minimum  preview  time  (sec) 

C  DMAX . upper  bound  on  front  wheel  angle  steer  (rad) 

C  XP,YP....x-y  path  coords (SAE)  wrt  inertial  coords  [input]  (ft) 

C  TAUMEM. . .driver  transport  time  dealy  [input  parameter]  (sec) 


C  TFF . driver  model  preview  time  [input  parameter]  (sec) 

C  RM . vehicle  mass  (slug) 

C  A . distance  from  c.g.  to  front  suspension  center-line  (ft) 

C  B . distance  from  c.g.  to  rear  suspension  center-line  (ft) 

C  RI . total  vehicle  yaw  inertia  (slug-ft) 

C  PSIO . current  yaw  angle  reference  value  (rad) 

C  NTF . nxmber  of  points  in  the  preview  time  interval 

C  NP . number  of  points  in  the  x-y  trajectory  table 

C  TLAST. . . .last  time  driver  model  calulated  a  steer  value  (sec) 

C  DFWLST . . . last  value  of  steer  calculated  by  driver  model  (rad) 

C  TILAST . . . last  sample  time  driver  model  calulated  a  steer  value  (sec) 

C  DMEM . 2-dim  array  (time  &  steer  history)  used  in  delay  calculat'n 

C  XT, YT. .. .transformation  of  XP,YP  in  vehicle  body  axes  (ft) 

C 

C - TRSSTR.BLK  common  block  variables - 

C 

C  TTT . transition  matrix  at  10  discrete  points  in  preview  interval 

C  TTTl . integral  of  trans  matrix  wrt  preview  time 

C  G . vector  of  control  gain  coefficients 

C 


C - VEHTYP  common  block  variables - 

C 

C  AAA. .. .Control  coefficient  A  defined  in  section  5.5  of  ref  [1] 

C  BBB ....  Control  coefficient  B  defined  in  section  5.5  of  ref  [1] 

C  CCC ....  Control  coefficient  C  defined  in  section  5.5  of  ref  [1] 

C  DDD ....  Control  coefficient  D  defined  in  section  5.5  of  ref  [1] 
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RATIO.. rear  steer  /  front  steer  ratio,  k,  defined  in  section  5.5 
— Local  variables - 


DELT . time  step  in  local  Euler  integration  (sec) 

A1 . lat  accel  coefficient  of  sideslip  veloc  in  linearizd  system 

B1 .  "  yaw  rate  " 

A2 . .yaw  accel  "  sideslip  vel  " 

B2 .  "  yaw  rate  " 

Cl . steer  control  gain  coefficient  for  lateral  accel 

C2 . steer  control  gain  coefficient  for  yaw  moment 

ULAST . . . . last  value  of  forward  velocity  (ft/sec) 

NBEG . integer  startin  counter  value 

NENDl .... Integer  ending  counter  value 
NENDV. . . .integer  ending  counter  value 

J . integer  counter 

SV. ..... .state  vector;  y,v, r,yaw,x  [SAE] 

SVl . integral  of  state  vector 

SD . state  vector  derivative 


— Functions  and  subroutines 
None 


^Process  Block= 


DELT  =0.01 

A1  =  -2.  *  (CAF  +  CAR)  /  RM  /  U 

B1  =  2.  *  (CAR  *  B  -  CAF  *A)/RM/U  -  U 

A2  =  2.  *  (CAR  *  B  -  C:AF  *  A)  /  RI  /  U 

B2  =  -2.  *  (CKR  *  B  *  B  +  CAF  *A*A)  /RI/U 

Cl  =  2.  *  (CAF  +  RATIO  *  CAR)  /  RM  *  AAA  +  BBB  /  RM 

C2  =  2.  *  (A  *  CAF  -  RATIO  *  B  *  CAR)  /  RI  *  CCC  +  DDD  /  RI 

ULAST  =  U 

G(l)  =  0. 

G(2)  =  Cl 
G(3)  =  C2 
G(4)  =  0. 

DO  70  J  =  1,  4 

NBEG  =  TSS  /  DELT  +  1 

NENDl  =  (TFF  +  .001  -  TSS)  /  NTF  /  DELT 
NENDV  =  NENDl 
DO  10  L  =  1,  4 
SV(L)  =  0.0 
SVI(L)  =  0.0 
10  CONTINUE 
TIME  =  0. 

Initialize  each  state  in  turn  to  1.0  and  integrate. 
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SV(J)  =1.0 
DO  60  I  =  1,  NTF 

DO  40  K  =  NBEG,  NENDV 

SD(1)  =  SV(2)  +  U  *  SV(4) 

SD(2)  =  A1  *  SV(2)  +  B1  *  SV(3) 

SD(3)  =  A2  *  SV(2)  +  B2  *  SV(3) 

SD(4)  =  SV(3) 

DO  20  L  =  1,  4 

SV(L)  =  SV(L)  +  SD(L)  *  DELT 
20  CONTINUE 

TIME  =  TIME  +  DELT 
DO  30  L  =  1,  4 

SVI(L)  =  SVI(L)  +  SV(L)  *  DELT 
30  CONTINUE 

40  CONTINUE 

Store  "impulse"  responses  in  TTT  columns,  integral  in  TTTl. 

TTT  is  a  NPT-point  tabular  transition  matrix,  TTTl  is  its  integral. 
(See  References  2  &  3.) 

DO  50  L  =  1,  4 

TTT(L,J,I)  =  SV(L) 

TTT1(L,J,I)  =  SVI(L) 

50  CONTINUE 

NBEG  =  NBEG  +  NENDl 
NENDV  =  NENDV  +  NENDl 
60  CONTINUE 
70  CONTINUE 
RETURN 
END 


***  Closed-Loop  Steer  Calculation  Stibroutine  *** 

DRIVER:  Computes  closed-loop  steering  control  during  the  simulation 

=-" --•= . Author  and  Modification  Section- ---  — ^ ^ 

Author:  C.  C.  MacAdam 

Date  written:  01/01/88 
Written  on: 

Modifications : 


====Algorithm  Description 
Purpose  and  use: 

Error  conditions: 
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C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c= 

c 
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Machine  dependencies:  none 
Called  By:  USER49.F77 


SUBROUTINE  DRIVER  (X,  Y,  DFW,  DFWNOW) 


Variable  Descriptions= 


- Argments  passed: 

->  X . time  in  the  simulation  (sec) 

->  Y . CTorrent  driver  model  state  vector  obtained  from  DADS. 

Driver  model  state  vector  of  dimension  5  comprised  of  the 
following  physical  qucintltles:  [1]  inertial  lateral 
displacement  (ft) ,  [2]  lateral  veloc  in  body  frame  (ft/s) , 

[3]  yaw  rate  global  (rad/s),  [4]  SAE  global  yaw  angle  (rad), 

[5]  global  forward  displacement  (ft) . 

<-  DFW . closed-loop  steering  control  returned  to  DADS  (returned) 

->  DFWNOW. . .current  steering  angle  [average]  of  front  wheels,  passed 
in  after  effects  of  roll-steer,  compliance,  etc. 


INTEGER  R,  W 
DIMENSION  Y(5),  YC(5) 

DIMENSION  DUMV11(4) 

DIMENSION  DUMV1(4),  VECM(4) 
DIMENSION  DUMM1(4,4),  DUMM2(4,4) 

— CCM40N  blocks - 


CCayiMON  /DRVSTl/  GRAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  RM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(1000,2),  XT (100),  YT(IOO) 

SAVE/DRVSTl/ 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
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SAVE/DRXV/ 

COMMON  /INOUT/  R,  W 
SAVE/INOUT/ 

COMMON  /TRSSTR/  TTT(4,4,10),  TTTl (4, 4, 10) ,  G{4)  ■ 

SAVE/TRSSTR/ 

C 

C  Get  Tire  Cornering  Stiffnesses,  Vertical  Tire  Loads,  and  Speed 
C  from  DADS  Through  Common  Block  DMTIR 
C 

COMMON/DMTIR/CCAFl , CCAF2 , CCARl , CCAR2 , FFZLl , FFZL2 , FFZL3 , FFZL4 , 
+  DMVELC 
C 

C - COMMON  Variables - 


C  R . Driver  Model  Input  I/O  unit  ("DMINPUT.INP") 

C  W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT") 

c  ■ 


C - DRIV.BLK  common  block  variables - - - 

C 

C  Initial  Values  from  Time  Zero: 

C 

C  CAF... total  cornering  stiffness  of  tires  on  left  front  susp  (Ib/rad) 
C  CAR. . .total  cornering  stiffness  of  tires  on  left  rear  susp  (Ib/rad) 

C  WHBS. .wheelbase  of  vehicle  (center-line  of  front  &  rear  susp)  (ft) 

C  WF.... static  load  on  front  suspension  (lb) 

C  WR. . . . static  load  on  rear  suspension  (lb) 

C  U . initial  velocity  (ft/sec) 

C 

C - DMTIR. BLK  common  block  variables - 

C 

C  Updates  during  simulation  run: 

C 

C  CCAFl...Left  front  tire  cornering  stiffness  from  DADS  during  run 
C  CCAF2 ... Right  front  tire  cornering  stiffness  from  DADS  during  run 
C  CCARl... Left  rear  tire  cornering  stiffness  from  DADS  during  run 
C  CCAR2 ... Right  rear  tire  cornering  stiffness  from  DADS  during  run 
C  FFZLl... Left  front  tire  vertical  load  from  DADS  during  run 
C  FFZL2. . .Right  front  tire  vertical  load  from  DADS  during  run 
C  FFZL3. .  .Left  recir  tire  vertical  load  from  DADS  during  run 
C  FFZL4. . .Right  rear  tire  vertical  load  from  DADS  during  run 
C  DMVELC . . . Forward  speed  from  DADS 
C 

C - DRVSTl.BLK  common  block  variables  - 

C 

C  GRAV . gravitational  constant 

C  TICYCL. . .driver  model  sample  time  (sec) 

C  TSS . minimum  preview  time  (sec) 

C  DMAX . upper  bound  on  front  wheel  angle  steer  (rad) 

C  XP,YP....x-y  path  coords (SAE)  wrt  inertial  coords  [input]  (ft) 

C  TAUMEM. .  .'driver  transport  time  dealy  [input  parameter]  (sec) 


C  TFF . driver  model  preview  time  [input  parameter]  (sec) 

C  RM . vehicle  mass  (slug) 

C  A . distance  from  c.g.  to  front  suspension  center-line  (ft) 

C  B . distance  from  c.g.  to,  rear  suspension  center-line  (ft) 

C  RI . total  vehicle  yaw  inertia  (slug-ft) 


C  PSIO . current  yaw  angle  reference  value  (rad) 
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C  NTF . number  of  points  in  the  preview  time  interval 

C  NP . number  of  points  in  the  x-y  trajectory  table 

C  TLAST. . . .last  time  driver  model  calulated  a  steer  value  (sec) 

C  DFWLST . , . last  value  of  steer  calculated  by  driver  model  (rad) 

C  TILAST. . .last  sample  time  driver  model  calulated  a  steer  value  (sec) 

C  DMEM . 2-dim  array  (time  &  steer  history)  used  in  delay  calculat'n 

C  XT, YT. ..  .transformation  of  XP,YP  in  vehicle  body  cixes  (ft) 

C 

C - TRSSTR.BLK  common  block  variables  - 

C 

C  TTT . transition  matrix  at  10  discrete  points  in  preview  interval 

C  TTTl . integral  of  trans  matrix  wrt  preview  time 

C  G . vector  of  control  gain  coefficients 

C 

C - Local  variables - 

C 

C  YC . local  (body-axis  based)  copy  of  state  vector  Y 

C  VECM . observer  vector  -  lateral  displacement  from  state  vector 

C  DUMVl. . . .work  vector 
C  DUMVll... 

C  DUMMl. . . .work  matrix 
C  DUMM2....  " 

C  T . time  in  the  simulation  (sec) 

C  EPSI . yaw  angle  between  body  aixis  and  current  index  value,  PSIO 

C  PSIO . current  nominal  value  of  . yaw  angle  used  for  linearization 

C  NP . number  of  points  in  x-y  path  table 

C  XP,YP....x-y  inertial  path  table  [input]  (ft) 

C  XT,YT....x-y  path  table  transformed  to  body  axis  [PSIO]  system  (ft) 

C  EPSY2 ....  emulative  preview  path  error  squared 

C  EPSY . mean  squared  value  of  emulative  preview  path  error 

C  TSUM . scalar  work  qucintity 

C  SSUM . scalar  work  quantity 

C  DFWLST. . .steering  control  from  last  calculation  (rad) 

C  TJI . preview  time  ahead  from  present  time  value  (sec) 

C  I, J,K. .. .integer  counters 

C  XCAR . preview  distance  eihead  in  feet  (ft) 

C  XO . present  forward  postion  of  vehicle  c.g.  (ft) 

C  TTAB . current  time  less  the  driver  delay,  TAUMEM.  Used  to  access 

C  the  delayed  driver  response  stored  in  DMEM  array,  (sec) 

C  SI . scalar  work  quantity 

C  T1 . scalar  work  quantity 

C  EP . previewed  path  error  (ft) 

C 

C - Functions  and  subroutines - 

C 

EXTERNAL  TRAJ,  GMPRD 


=Process  Block= 

DATA  VECM  /l.O,  3*0.0/ 
C 

1  T  =  X 


D-17 


oooo  nan  nnnnnnnn  nnn  n  nnn 


EPSI  =  ABS(Y(4)  -  PSIO) 

DO  10  I  =  1,  5 
10  YC(I)  =  Y(I) 

IF  (EPSI  .LE.  .0002)  GO  TO  30 

Update  Coordinate  Transformation 

PSIO  =  Y(4) 

DO  20  J  =  1,  NP 

XT(J)  =  XP(J)  *  COS(PSIO)  +  YP(J)  *  SIN(PSIO) 

20  YT(J)  =  -XP(J)  *  SIN  (PSIO)  +  YP(J)  *  COS  (PSIO) 

30  YO  =  -Y(5)  *  SIN  (PSIO)  +  Y(l)  *  COS (PSIO) 

XO  =  Y(5)  *  COS (PSIO)  +  Y(l)  *  SIN  (PSIO) 

YC(1)  =  YO 

YC(4)  =  Y(4)  -  PSIO 

EPSY2  =0. 

TSUM  =0. 

SSUM  =  0. 

DFW  =  DFWLST 

Return  if  time  fron  last  calculation  less  than  sample  interval 

IF  (T  --  TILAST  .LE.  TICYCL)  RETURN 

The  next  6  lines  of  executable  code  may  be  commented  out  to 
bypass  continuous  updating  of  the  transition  matrices.  If  not 
required.  See  section  5.8  of  reference  1. 

Update  tire  cornering  stiffnesses  and  vehicle  velocity 
and  recalculate  transition  matrix: 

CAFTEM  =  (CCAF1*FFZL1+CCAF2*FF2L2)  /  (FFZL1+FFZL2) 

CARTEM  =  (CCAR1*FFZL3+CCAR2*FFZL4)  /  (FFZL3+FFZL4) 

CAF  =  CAFTEM 
CAR  =  CARTEM 
U  =  DMVELC 

Update  Transition  Matrices 
CALL  TRANS 

Loop  to  calculate  optimal  preview  control  per  References  2  &  3: 
(NTF  points  within  the  preview  interval) 

DO  50  I  =  1,  NTF 

TOT  =  (TFF  -  TSS)  /  NTF  *  I  +  TSS 
DO  40  J  =  1,  4 
DO  40  K  =  1,  4 

DUMM1(J,K)  =  TTT1(J,K,I) 

40  DUMM2(J,K)  =  TTT(J,K,I) 

CALL  GMPRD(VECM,  DUMML,  DUMVll,  1,  4,  4) 

CALL  (24PRD(VECM,  DUMM2,  DUMVl,  1,  4,  4) 

CALL  GMPRD(DUMV1,  YC,  Tl,  1,  4,  1) 
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Get  observed  path  input,  YPATH,  within  preview  interval  at  XCAR  ft: 

XCAR  =  XO  +  U  *  TJI 

CALL  TRAJ(XCAR,  XT,  YT,  YPATH) 

CALL  GMPRD(DUMV11,  G,  SI,  1,  4,  1) 

EP  is  the  previewed  path  error  at  this  preview  point. 

EP  =  T1  +  SI  *  DFWNOW  -  YPATH 
TSUM  =  TSUM  +  EP  *  SI 
SSUM  =  SSUM  +  SI  *  SI 

Cumulative  preview  error  calculation  (unrelated  to  control) 

EPSY2  =  EPSY2  +  EP  *  EP  *  (TFF  -  TSS)  /  NTF 
50  CONTINUE 

Cumulative  preview  error  calculation  (unrelated  to  control) 

EPSY  =  SQRT(EPSY2)  /  (TFF  -  TSS) 

Optimal  value  -  no  delay  yet. 

DFW  =  -TSUM  /  SSUM  +  DFWNOW 

Maximm  steer  bound  set  at  DMAX  (arbitrciry) 

IF  (ABS(DFW)  .GT.  DMAX)  DFW  =  DMAX  *  SIGN (1., DFW) 

Store  steer  history  and  corresponding  times  in  DMEM. 

Retrieve  steer  delayed  by  TAUMEM  sec  and  return  as 
delayed  driver  steer  control,  DFW. 

DO  60  J  =  1,  2 
DO  60  I  =  1,  999 

60  DMEM(1001  -  I,J)  =  DMEMdOOO  -  I,J) 

DMEM(1,1)  =  DFW 
DMEM(1,2)  =  T 
TTAB  =  T  -  TAUMEM 
DO  70  I  =  1,  999 

IF  (DMEM(I  +  1,2)  .LE.  TTAB  .AND.  DMEM(I,2)  .GE.  TTAB) 

1  GO  TO  90 
70  CONTINUE 

WRITE  (W,  80)  TAUMEM, DFW, X 

80  FORMAT  ('O',  '*****  TAUMEM  PROBABLY  TOO  LARGE  ****★', 

&  /,3(1X,G12.6)) 

CALL  EXIT 
90  DFW  =  DMEM  (1,1) 

Save  steer  and  time  values  for  next  calulation. 

DFWLST  =  DFW 
TLAST  =  X 
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TILAST  =  X 

RETURN 

END 

★★★★★★★★★★  ★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★ ★ 

c 

C  ***  Trajectory  Siobroutine  *** 

C 

C  TRAJ:  Cqmputes  lateral  displacement  of  previewed  path  as  a  table 
C  look-up 

C 

C-  --=  —  ■  Author  and  Modification  Section- - ^  . — = :=■=  = 

C 

C  Author:  C.  C.  MacAdam 

C 

C  Date  written:  01/01/88 
C  - 

C  Written  on: 

C 

C  Modifications : 

C 

C . -  . . . -  —  -  ■-  "■  - 

c 

C‘---== — -  Algorithm  Description==  -= --== -■  — -====r= 

C 

C  Piarpose  and  use: 

C 

C  Error  conditions : 

C 

C  Machine  dependencies:  none 
C 

C  Called  By:  DRIVER 
C 

C=-===="="^'^= . . . -  . .  . .  . - . 

c 

SUBROUTINE  TRAJ(X,  XT,  YT,  YPATH) 


C 

C . . . . .  Variable  Descrlptlons== . --= . -— . . . . --=  . . 

C 

C - Arguments  passed: 

C 

C  ->X . forward  displacement  (ft) 

C  ->XT . longitudinal  path  coordinates  (ft) 

C  ->YT . lateral  path  coordinated  corresponding  to  XT  values  (ft) 

C  <- YPATH. . .lateral  displacement  of  path  corresponding  to  X,  (ft) 

C 

C 


INTEGER  R,  W 
DIMENSION  XT (*) ,  YT(*) 
C 

C - COMMON  blocks - 

C 

COMMON  /INOUT/  R,  W 
SAVE/INOUT/ 

C 
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— CCMON  Variables - 

R . Driver  Model  Input  I/O  unit  ("DMINPUT.INP") 

W . Driver  Model  Output  I/O  unit  ("DMOUTPUT.OUT") 

- Local  variables - 

J . integer  counter 

SLOPE.. .dYT/dXT  of  path  at  X 

— Functions  and  subroutines - - 

None 


'Process  Block' 


SEARCH  FOR  XI,XI+1: 

DO  10  J  =  1,  99 

IF  (X  .GE.  XT(J)  .AND.  X  .LT.  XT(J  +  1))  GO  TO  30 
10  CONTINUE 
WRITE  (W,20) 

20  FORMAT  ('O',  'X-SEARCH  IN  SUB.  TRAJ  FAILED.') 

CAXiXi  F.YTT 

30  SLOPE  =  (yT(J  +  1)  -  YT(J))  /  (XT(J  +1)  -  XT{J)) 
YPATH  =  YT ( J)  +  SLOPE  *  (X  -  XT ( J) ) 

RETURN 

END 


***  Matrix  Product  Subroutine  *** 
(sMPRD:  Computes  matrix  product 

. . . ----Author  and  Modification  Section' 

Author:  IBM  Scientific  Subroutine 

Date  written: 

Written  on: 

Modifications:  C.  MacAdam 


=====Algorithm  Description 
Purpose  and  use:  R  =  A  B 
Error  conditions : 

Machine  dependencies:  none 
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Called  By:  DRIVER 


SUBROUTINE  6MPRD  (A,  B,  R,  N,  M,  L) 


C 

C- —  ---  -Variable  Descriptlons==^  ---  ■ .  --- 

C 

C - Arguments  passed: 

C 

C  A . N  X  M  matrix 

C  B . M  X  L  matrix 

C  R . N  X  L  resultant  matrix  =  A  B  product 

C  N . integer  row  dimension  of  A 

C  M . integer  column  dimension  of  A  (or  row  dimension  of  B) 

C  L . integer  coluonn  dimension  of  B 

C 


DIMENSION  A  (N*M) ,  B(M*L),  R(N*L) 

C 

C - COMMON  blocks - - 

C 

C  None 

C 

C - COMMON  Variables - 

C 

C  None 

C 

C - Local  variables - 

C 

C  IR,  IK,  M,  K,  L,  IR,  JI,  J,  N,  IB,  IK,  etc . integer  counters 

C 

C - Functions  and  subroutines - 

C 

C  None 

C 

C . ^-== . . . . . .  . . . . . . . " . . 3===. . . . . . . . . .  . ^ 

c 

C--' -== . -==== . ! -Process  Block—  . . . .  --■== . ---=  . .  . .  =-:::i==:= 

C 

IR  =  0 
IK  =  -M 
DO  10  K  =  1,  L 
IK  =  IK  +  M 
DO  10  J  =  1,  N 
IR  =  IR  +  1 
JI  =  J  -  N 
IB  =  IK 
R(IR)  =  0. 

DO  10  I  =  1,  M 
JI  =  JI  +  N 
IB  =  IB  +  1 

10  R(IR)  =  R(IR)  +  A(JT)  *  B(IB) 

RETURN 

END 
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Appendix  E 

FORTRAN  DADS  /  Driver  Model 

Interface  Code 


E-1 


E-2 


This  appendix  contains  FORTRAN  code  that  was  used  by  the  CADSI  /  DADS  program  at 
TACOM  to  call  the  driver  model  code  appearing  in  Appendix  D  or  to  calculate  information 
for  its  use  with  DADS.  Most  of  this  code  was  developed  by  TACOM  personnel  and  is 
included  here  to  illustrate  the  calling  mechanisms  used  to  interface  the  DADS  code  to  the 
driver  model  of  Appendix  D. 

The  following  subroutines  are  listed  in  this  appendix: 

•  USER49  called  by  DADS;  USER49  calls  DRIVER  of  Appendix  D 

•  TIREF  called  by  DADS  for  tire  forces  /  cornering  stiffnesses 

•  FILTER  called  by  USER49 

•  EULANG  called  by  USER49 

USER49  is  the  primary  interface  between  DADS  and  the  driver  model  and  is  used  to 
control  external  calls  to  user-defined  functions.  TIREF  is  included  to  show  how  the  tire 
cornering  stiffnesses  are  calculated  and  stored  in  a  common  block  for  use  by  the  driver 
model  routine  DRIVER. 

The  subroutine  FILTER  is  a  second  order  filter  called  by  USER49  to  obtain  first  and 
second  order  derivatives  of  the  driver  steering  control  returned  by  DRIVER.  These 
derivatives  were  required  by  DADS  for  the  constraint  calculations  associated  with  the 
pitman  arm  steering  mechanism.  An  additional  FILTER  call  was  used  to  further  smooth 
the  derivative  time  histories.  Small  delays  introduced  by  the  filtering  were  compensated  by 
reducing  the  driver  model  time  delay  parameter. 

EULANG  is  an  auxilliary  subroutine  used  to  calcuate  and  write  out  to  an  external  file  Euler 
angle  and  position  information  for  subsequent  animation  processing  at  UMTRI.  (optional) 
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USER49:  Calculates  User  supplied  values  for  the  driving  function 
======Author  and  Modification  Section  -  —  = 

Author:  James  A.  Aardema,  C.  MacAdam 

Date  written:  07/01/87,  02/01/88 
Written  on: 

Modifications: 


-■-=  . -==Algorithm  Description: 

Purpose  and  use:. 

Error  conditions : 

Machine  dependencies:  none 
Called  By:  FUN49.FOR 


SUBROUTINE  USER49  (  IRE,  FN,  AJ,  ND,  DRV,  IDRV,  Q,  QD,  A,  lA, 
&  MP.TRS,  NPTRS,  RB,  NPRB,  QDR,  QDDR,  NB,  RVLT, 

&  TRAN,  CYL,  NPRT,  NPTRN,  NPCYL,  QDD, 

&  CST,  CSTD,  CSTDD,  IDRTVER  ) 


C====— . 'Variable  Descriptlons==-  — '  '  ="-=  - - -===■ ' ~=~ — - 

C 

C - Arguments  passed - - - 

C 

C  ND  .  number  of  driving  constraint 

C  lA  .  total  integer  array 

C  A  .  total  real  array 

C  IDRV  . . .IA(MP  (12) ) . . .  integer  array  for  the  driving  constraint 

C  NPTRS  .  real  data  item  per  constraint 

C  TRAN  .  Real  data  for  the  translational  joint. 

C  CYL  .  Real  data  for  the  cylindrical  joint. 

C  RVLT  .  Real  data  for  the  revolute  joint. 

C  NPTRN .  Number  of  real  data  per  translational  joint. 

C  NPCYL  .  Number  of  real  data  per  cylindrical  joint. 

C  NPRT  .  Number  of  real  data  per  revolute  joint. 

C  DRV  . . . .A(NP (12) ) . . .  real  data  for  driving  constraint 

C  Q  ....A(  N1  )....  position 

C  QD  ....A(  N2  )....  velocity 

C  QDD  ....A(  N3  )....  acceleration 

C  QDR  Q  (IQ  (MM) )...  position 

C  QDDR _ QD(IQ(MM))..  velocity 
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IKE  .  . 

NB 

CST 

CSTD  . 
CSTDD  . 
IDRTVER 


.A(  N5  ) . . . .  Jacobian  matrix 

.A(  N8  )....  temporary  array  for  the  constraint  equation 
r.h.s.  of  velocity  or  acceleration  equation 
lA (  M7  ) . . . .  flag  for  redundant  constraint 

. . . .  number  of  rigid  bodies  in  the  model 

.  driving  function 

.  first  derivative  of  driving  function 
.  second  derivative  of  driving  ftanction 
..Current  driver  being  analyzed 


INTEGER  MPTRS,  NPTRS,  ND,  IDRV(MPTRS,ND) ,  IA(0:1), 

&  IRE(l) ,NPRB/  NB,  NPTRN,  NPCYL,  NPRT,  IDRIVER 

DOUBLE  PRECISION  FN(1),  AJ(1),  DRV (NPTRS, ND) ,  Q(7,l),  QD(7,1), 
&  RB(NPRB,NB),  QDR(l),  QDDR(l),  A(0:1), 

&  TRAN (NPTRN, 1),  CYL (NPCYL, 1) ,  RVLT (NPRT, 1 ) , 

&  QDD(7,1),  CST,  CSTD,  CSTDD 


- COMMON  blOCks- 


INSERT  CADSI>DADS4.DIR>CCM«)N>STEPHT 
INSERT  CADSI>HMMWV>STEER>CC»1M0N>UPL0T.BLK 


- CCWMON  Variables- 


— STEPHT  common  block  variables- 


H . 

HMAX. . 
TSTART 
TEND. . 
TSTEP. 

T . 

HSTLEN 

HSTPTR 

HSTCNT 


HSTH. . 
HSTK. . 
HSTERR 

- UPLOT 

UPLOT 

NPLOT 


..Integration  predictor  step  size. 

..Maximum  integration  predictor  step  size. 

..Time  at  the  start  of  the  simulation. 

..Time  when  simulation  is  to  stop. 

..Integration  step  size. 

. .Current  time  during  the  simulation. 

..Length  of  the  history  arrays. 

..Pointer  to  the  last  used  location  in  the  history  arrays. 
. .Count  of  the  number  of  time  steps  for  which  integration 
history  was  saved. 

. .Past  history  of  the  integration  time  step. 

.  .Past  history  of  the  integration  order. 

..Past  history  of  the  integration  error  estiinate. 


BLK  Common  Vciriables- 


. .  .Array  for  storing  user  vciriables 
. . .Number  of  plot  variables  used 


— Local  vciriables- 


Kll....  EQ.O  ;  do  not  evaluate  Jacobian  matrix 
EQ.l  :  evaluate  Jacobiain  matrix 

K22....  EQ.l  ;  evaluate  Jacobian  matrix 

EQ.2  :  evaluate  constraint  equation 

EQ.3  :  evaluate  r.h.s.  of  the  velocity  equation 

EQ.4  :  evaluate  r.h.s.  of  the  acceleration  equation 
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c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

,c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c- 


JBl  . . .  first  body  number  of  driving  constraint  is  imposed 
JB2  . . .  second  body  ntimber  of  driving  constraint  is  imposed 
JTYPE  . .  type  of  driving  constraint  joint . 

=1  Revolute  joint 
=2  Cylindrical  joint 
=3  Translational  joint 
FTYPE  . .  Driving  function. 

EQ.l  :  polynomial  driving  function 

coeffl  +  coeff2*T  +  coeff3*T**2  +  coeff4*T**3 
EQ.2  :  harmonic  driving  function 

coeffl  +  coeff2  *  SIN  (  coeff3*T  -  coeff4  ) 

EQ.3  :  general  driving  fimction 

coefficients  of  the  driving  functions 
polynomial  harmonic  general 

coeffl :  constant  term  constant  term  not  used 

coeff2;  1st  order  coef.  amplitude  not  used 

coeff3:  2nd  order  coef.  frequency  not  used 

coeff4:  3rd  order  coef.  phase  shift  not  used 

DTYPE  ...Type  of  constraint  defined: 

EQ.l  :  constrain  Xpi 
EQ.2  :  constrain  Ypi 
EQ.3  :  constrain  Zpi 
EQ.4  :  constrain  Xpj  -  Xpi 
EQ.5  :  constrain  Ypj  -  Ypi 
EQ.6  :  constrain  Zpj  -  Zpi 

EQ.7  :  constrain  distance  between  two  position 
EQ.8  :  relative  angle  constraint  on  revolute  or  cylin¬ 
drical  joint 

EQ.9  :  constrain  relative  position  on  translational  or 
cylindrical  joint 
FT  ...  value  of  general  curve 
NZHS  . . .  pointer  for  Jacobian  array 
ITEMP  . . .  temporary  value 

PNTR  . . .  pointer  into  the  input  data  array 
DNAME  . . .  name  of  a  distance  driver 
JN  ...  joint  number. 

ICHS...Body  number  of  the  chassis 

INTEGER  JBl,  JB2,  DTYPE,  JTYPE,  Kll,  K22,  NZHS,  ITEMP, 

&  PNTR,  FTYPE,  JN,  ICHS 

DOUBLE  PRECISION  ACHS(3,3),  PHI,  STEER,  DSTEER,  DDSTEER 

REAL*4  Y(5),  DFWOUT,  DFWOLD,  DF,  DFVEL,  DFACC,  DFF 
REAL  TDRIV 

REAL*4  A1LST,B1LST,C1LST,D1LST,E1LST,A2LST,B2LST, 

1  C2LST,D2LST,E2LST 
\ 

CHARACTER*20  DNAME 


— Functions  and  subroutines 


E-6 


noon  no 


EXTERNAL  FSPLIN,  SIMDR,  ELMDR,  DISTDR,  TRANDR,  SINE,  COSINE, 
&  TRULEN,  DRIVER,  FILTER 

EXTERNAL  EULANG 

INTEGER  TRULEN 

DOUBLE  PRECISION  FSPLIN 
DOUBLE  PRECISION  YANIM(3) 

INTRINSIC  DCOS,  MOD,  DSIN,  DABS,  DATAN,  DSIGN,  DATAN2, 

&  SNGL,  DBLE 

SAVE  DFWOLD 

SAVE  AILST, BILST, CILST, DILST, EILST, A2LST, B2LST, 

1  C2LST,D2LST,E2LST 


======PrOCeSS  Block .  . ;r'==riz;  ^  . .  '  ' ^ 

Initalize  filter  varaibles  to  zero  at  start. 

IF(T  .LE.  0.001)  THEN 
DFWOUT  =0.0 
STEER  =0.0 
A1LST=0 . 0 
B1LST=0.0 
C1LST=0.0 
D1LST=0.0 
E1LST=0.0 
A2LST=0.0 
B2LST=0 . 0 
C2LST=0.0 
D2LST=0 . 0 
E2LST=0 . 0 
ENDIF 

C - Get  the  chassis  body  number 

ICHS  =  IDRV(1,IDRIVER)  /*  IDRTVER  is  the  current  driver  being 
analyzed 

C - Get  the  chassis  transformation  matrix 


C 


ACHS(1,1) 
ACHS(2,1) 
ACHS(3,1) 
ACHS(1,2) 
ACHS(2,2) 
ACHS(3,2) 
ACHS(1,3) 
ACHS (2, 3) 
ACHS(3,3) 


RB  (38,  ICHS) 
RB (39, ICHS) 
RB  (40,  ICHS) 
RB (41, ICHS) 
RB (42, ICHS) 
RB (43, ICHS) 
RB (44, ICHS) 
RB (45, ICHS) 
RB (46, ICHS) 
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C  Call  to  EulAng  for  Animation  Output 
C 

YANIM(l)  =  Q(2,ICHS)  /  12. 

YANIM(2)  =  Q(1,ICHS)  /  12. 

YANIM(3)  =  -(Q(3,ICHS)  -  RB(20,ICHS))  /  12. 

CALL  EULANG  (T,  YANIM,  ACHS) 

C 

Y(2)  =  SNGL(  ACHS(1,1)*QD(1,1CHS)  + 

&  ACHS(2,1)*QD(2,ICHS)  + 

&  ACHS(3,1)*QD(3,ICHS) )/12.0  /*  lateral  velocity  in 

body  cs 

C - Get  the  current  vehicle  global  position 

C 

C  SAE  conventions  used  to  define  position  and  orientation  for  driver 
C  model  arguments  passed  in: 

C 

C  Y(l)  lateral  SAE  global  position  (DADS  global  X) 

C  Y(2)  SAE  body  sideslip  velocity  component  (see  above) 

C  Y(3)  SAE  yaw  rate  (DADS:  minus  "PHIDOT") 

C  Y(4)  SAE  Yaw  angle  (DADS:  minus  "PHI") 

C  "Y (5)  forward  SAE  global  position  (DADS  global  Y) 

Y(l)  =  SNGL(Q(1,ICHS) )/12.0  /*  LATERAL  DISPLACEMENT  -  SAE 

Y(5)  =  SNGL(Q(2,ICHS) )/12.0  /*  FORWARD  DISPLACEMENT  -  SAE 

Y(3)  =  -SNGL(RB(34,ICHS) )  /*  SAE  YAW  RATE  -  GLOBAL 

PHI  =  DATAN2 (ACHS (1,2),  ACHS (2, 2)  )  /*  SAE  YAW  ANGLE 

Y(4)  =  SNGL(PHI) 

C 

C  Plot  variables : 

C 

UPLOT(NPLOT+l)  =  DBLE(Y(1)) 

UPLOT(NPLOT+2)  =  DBLE(Y(2)) 

UPLOT(NPLOT+3)  =  DBLE(Y(3)) 

UPLOT (NPLOT+  4 )  =  DBLE ( Y ( 4 ) ) 

UPLOT(NPLOT+5)  =  DBLE (Y (5)) 

C - Calculate  the  steering  control  from  the  steering  model 

C  If  STEER  >0.0  Turn  Right 
C  If  STEER  <0.0  Tiorn  Left 

TDRIV  =  SNGL(T) 

C 

C  Call  to  Driver  Model: 

C 

CALL  DRIVER  (  TDRTV,  Y,  DFWOUT,  DFWOLD  ) 

C 

C  Filter  DFWOUT  steering  control  from  DRIVER  for  derivatives  DFVEL 
C  and  DFACC: 

C 

CALL  FILTER (TDRTV, DFWOUT, DF, DFVEL, DFACC, AILST, BILST, CILST, 

1  D1LST,E1LST) 

C 
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Plot  variables: 


UPL0T(NPL0T+6)  =  DBLE(DFWOUT) 

UPL0T(NPL0T+7)  =  DBLE(DFWOLD) 

UPL0T(NPL0T+8)  =  DBLE(O.O) 

UPLOT (NPLOT+9)  =  DBLE(DF) 

UPLOT(NPLOT+10)  =  DBLE (DFVEL) 

UPLOT (NPLOT+11)  =  DBLE(DFACC) 

Further  smoothing  (optional) : 

CALL  FILTER  (TDRIV, DF, DFF, DFVEL, DFACC, A2LST, B2LST, C2LST, 

1  D2LST,E2LST) 

DFWOLD  =  DFF 

STEER  =  DBLE (DFF) 

DSTEER  =  DBLE (DFVEL) 

DDSTEER  =  DBLE (DFACC) 

Plot  variables; 

UPLOT (NPLOT+12)  =  STEER 
UPLOT(NPLOT+13)  =  DSTEER 
UPLOT(NPLOT+14)  =  DDSTEER 

- Calculate  the  pitman  arm  angle  from  the  tire  steering  angle 

The  ratio  between  steering  aingle  and  pitman  arm  angle  is  1.166D0 

CST  =  1.166D0  *  STEER 

CSTD  =  1.166D0  *  DSTEER 

CSTDD  =  1.166D0  *  DDSTEER 


CST  =  FSPLIN(T,  0.0,  IDRV(5,IDRrVER) ,  1,  A,  lA,  0,  0) 

IF  (  ERRCOD  .NE.  0  )  RETURN 

CSTD  =  FSPLIN(T,  0.0,  IDRV(5, IDRIVER) ,  1,  A,  lA,  1,  0) 

IF  (  ERRCOD  .NE.  0  )  RETURN 

CSTDD  =  FSPLIN(T,  0.0,  IDRV(5,IDRrVER) ,  1,  A,  lA,  2,  0) 

IF  (  ERRCOD  .NE.  0  )  RETURN 

— Pitman  airm  travel  is  limited  to  38.25  degrees  or  0.668  radians 

IF  (  DABS (CST)  .GE.  0.668D0  )  THEN 
CST  =  DSIGN(0.668D0,CST) 

CSTD  =  O.ODO 
CSTDD  =  O.ODO 
ENDIF 

PRINT*,  '  • 

PRINT*,  'H. . .Integration  predictor  step  size',  H 

RETURN 

END 
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- TIKEF:  Calculates  the  forces  exerted  on  the  tire  through  the  road. 

—  Author  and  Modification  Section^  -  ---  . — - 

Author:  James  A.  Aardema,  Rick  Mousseau,  Roger  Weahage 

Date  written :  Unknown 
Written  on: 

Modifications : 


---= --==Algorithm  Description-—  —  — ^  . -  . 

Purpose  and  use:  Calculates  the  slip  angle,  lateral, 

longitudinal,  and  normal  tire  forces  for  a 
■point  follower  tire  model. 


SUBROUTINE  TIREF  (  I,  Q,  QD,  QDD,  FRC,  ITIR,  TIR,  RB,  A,  lA, 
&  NB,  NTR,  MPTRS,  NPTRS,  NPRB,  UDE,  DUDE,  NWHDE  ) 


IMPLICIT  DOUBLE  PRECISION  (A-H,P-Z) 


C= . . :-=::===  ■  'Variable  Descrlptions= . — "  . — ^ . — . . . 

C 

C - Arguments  passed - 

C 

C  I . Current  tire  being  calculated 

C  Q . Array  of  generalized  coordinates. 

C  QD . Array  of  velocities. 

C  QDD.... Array  of  acceleration  values. 

C  FRC. .. .Array  of  generalized  forces. 

C  ITIR. . .Array  of  integer  data  from  this  module. 

C  TIR. .. .Array  of  real  data  from  this  module. 

C  RB . Array  of  rigid  body  real  data. 

C  A. . . . . .Vector  of  all  real  data. 

C  lA . Vector  of  all  integer  data. 

C  NB . Nimber  of  rigid  bodies. 

C  NTR. . .  .Nim±ier  of  tire  elements. 

C  NPTRS. .Number  of  real  data  per  element. 

C  MPTRS. .Number  of  integer  data  per  element. 

C  NPRB. . .Number  of  real  data  per  rigid  body. 

C  UDE.... Array  of  user  differential  equations.  Position  terms 
C  DUDE... Array  of  user  differential  equations.  Velocity  terms 

INTEGER  NTR,  MPTRS,  NPTRS,  NPRB,  NWHDE, 
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&  NB,  IA(0;1),  ITIR(MPTRS,NTR),  I 

DOUBLE  PRECISION  A (0:1),  Q(7,l),  QD(7,1),  QDD(7,I),  FRC(7,1), 

&  TIR(NPTRS,NTR),  RB(NPRB,NB), 

&  UDE(NWHDE),  DUDE (NWHDE) 

C 

C - COMMON  blocks - - - 

C 

$INSERT  CADSI>DADS4 .  DIR>CCayiMON>STEPHT 
$INSERT  CADSI>DADS4 . DIR>COMMON>PARAM 
$INSERT  CADSI>DADS4 . DIRX:OMMON>POTEN 

$INSERT  CADSI>HMMWV>STEER>CayiMON>ALTORl .  BLK 
$INSERT  CADSI>HMMWV>STEERX:OMMON>ALTOR2.BLK 
$INSERT  CADSI>HMMWV>STEER>C(MON>RUNFLAT.BLK 
$INSERT  CADSI>HMMWV>STEERX:a®ON>SDFRCl.BLK 
$INSERT  CADSI>HMMWV>STEERX:OMMON>SDFRC2.BLK 
C 

C  Used  to  pass  tire  cornering  stiffnesses  and  loads  to  driver  model: 
C 

$INSERT  CADSI>HMMWV>STEER>COMMON>DMTIR.BLK 

C - STEPHT  common  Variables - - - 


C 

C  H . Integration  predictor  step  size. 

C  HMAX . Maximum  integration  predictor  step  size. 

C  TSTART. . .Time  at  the  start  of  the  simulation. 

C  TEND . Time  when  simulation  is  to  stop. 

C  TSTEP .... Integration  step  size. 

C  T . Current  time  during  the  simulation. 

C  HSTLEN. .  .Length  of  the  history  aurrays. 

C  HSTPTR. . .Pointer  to  the  last  used  location  in  the  history  arrays. 
C  HSTCNT ... Count  of  the  nimiber  of  time  steps  for  which  integration 
C  history  was  saved. 

C  HSTH . Past  history  of  the  integration  time  step. 

C  HSTK . Past  history  of  the  integration  order. 

C  HSTERR. . .Past  history  of  the  integration  error  estimate. 

C 

C 


C - PARAM.BLK  Common  Vairiables - 

C 

C  This  file  contains  a  number  of  constants  which  are  used  in  various 
C  subroutines  throughout  the  code  aind  are  stored  here  to  insure 
C  accuracy  and  make  any  changes  easier. 

C 

C  PI . pi 

C  TWOPI .... two  times  pi 
C  DEGRAD . . . degrees  per  radian 

C  MCHEPS. . .machine  epsilon 

C  BODMOD . . . number  of  the  rigid  body  module 

C  CRVMOD . . . number  of  the  curve  module 

C  INPEPS ...  epsilon  value  used  to  check  error  in  normalized  input 

C  values 

C 
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C - POTEN  Common  Variables 


C 

C  MSTAT . Flag  controling  whether  total  energy  is  to  be  calculated. 

C  V . Scalar  of  potential  energies. 

C  VBGN . Working  vector. 

C  F . Function  value  working  vector. 

C 


C - ALTORl.BLK  Common  Variables 


C 

C  .  NSAl . Nijmber  of  slip  cuigle  points 

C  NFZl . Number  of  vertical  force  points 

C  SANGLEl. . .Array  containing  the  slip  angle  points 

C  FZl . Array  containing  the  vertical  points 

C  ALTORl . . . . Grid  array  containing  the  aligning  torque  values 
C  IPSAl. ... .Array  containg  slip  angle  pointers 

C  IPFZl . Array  containg  vertical  force  pointers 

C 


C - ALT0R2.BLK  Common  Variables 


C 

C  NSA2 . Number  of  slip  angle  points 

C  NFZ2 . Number  of  vertical  force  points 

C  SANGLE2. . .Array  containing  the  slip  angle  points 

C  FZ2 . Array  containing  the  vertical  points 

C  ALT0R2 . . . . Grid  array  containing  the  aligning  torque  values 

C  IPSA2 . Array  containg  slip  angle  pointers 

C  IPFZ2 . Array  containg  vertical  force  pointers 

C 


C - RUNFLAT.BLK  Common  Variables- 

C 

C  RFRAD .... Run  Flat  Radius 

C  RFSTIF...Run  Flat  Stiffness 

C  RFDAMP . . . Run  Flat  Damping 

C 

C - SDFRCl  Common  Variables - 

C 

C  SFRCl (20,20) . 

C  ALREFl (20) . . . 

C  FZREFl (20) . . . 

C  IPAl  (20) . 

C  IPF1(20) . 

C  NAPNTl . 

C  NFPNTl . 

C 

C - SDFRCl  Common  Variables - 

C 

C  SFRC2 (20,20) . 

C  ALREF2 (20) . . . 

C  FZREF2 (20) . . . 

C  IPA2(20) . 

C  IPF2(20) . 

C  NAPNT2 . 

C  NFPNT2 . 

C 
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C - Local  variables 


C 

C  IBDY . ITIR(1,I) . .  .Body  nmnber  wheel  is  attached  to 

C  ICHS . ITIR(2,I) . .  .Body  number  defined  as  the  chassis 

C  lUTIL _ ITIR(3,I) . . .Utility  curve  number 

C  ITK . ITIR (4, 1) ..  .Vertical  Spring  rate  Curve  nxamber 

C  ILNG . ITIR (5,1)... Torque  Curve  number 

C  ISTR . ITIR(6, I) . . .Steer  Curve  number 

C  TYPE . ITIR (7, 1) ..  .Model  type 

C  RC(1) _ TIR(1,I) _ Wheel  center  postion  in  local  coordinates 

C  RC(2) . . . .TIR(2,I) 

C  RC(3) . . . .TIR(3,I) 

C  RAD . TIR(4,I) _ Tire  Radius 

C  RR . TIR(5,I) _ Rolling  Resistance 

C  TD . TIR(6,I) . . .  .Tire  Damping  constant 

C  TK. ..... .TIR{7,I) . . . .Tire  Vertical  Spring  Stiffness 

C  CALP . TIR(8,I) _ Lateral  Stiffness  of  the  tire 

C  STRAG. .. .TIR(9, I) ... .Steer  angle 

C  MU . TIR(10,I) . .  .Friction  Coefficient 

C  YAW . TIR(11,I) . .  .Yaw  angle  of  the  wheel  body 

C  VX . TIR(12,I)  . .  .Velocity  of  wheel  center  in  road  system 

C  VY . TIR(13,I) 

C  VZ . TIR(14,I) 


C  TIREl. .. .TIR (15,1) .. .Global  position  of  the  tire  center 

C  TIRE2 _ TIR(16,I) 

C  TIRE3. . . .TIR(17,I) 

C  TIREX. .. .TIR (18,1) .. .Global  postion  of  the  tire  bottom 

C  TIREY. . . .TIR(19,I) 

C  TIREZ. . . .TIR(20,I) 

C  ZROAD. . . .TIR (21, I) . . .Ground  Elevation 


C  DEFL . TIR(22,I) . . .Tire  Deflection  -  Ground  Penetration 

C  FSPR . TIR  ( 2  3 , 1 ) . . .  Spring  Force 

C  FDAMP _ TIR (24, 1) . .  .Damping  Force 

C  FNORM _ TIR(25,I) . .  .Normal  Force 

C  SLIP . TIR(26,I) . .  .Tire  Slip 

C  FLAT . TIR(27, 1) ..  .Lateral  force 

C  S . TIR(28, 1) ..  .Longitudinal  slip 

C  FLONG _ TIR(29, I) .. .Longitudinal  force 

C  GFRC . TIR(30, 1) ..  .Wheel  torque 

C  PENRF. .. .TIR( 31.1) .. .Penetration  into  the  run  fiat  assembly 

C  FRF . TIR(32,I) . . .Run  flat  force  due  to  penetration  onto  run 

flat 

C  ALGNTQ. . .TIR(33, I) .. .Aligning  Torque  due  to  lateral  slip 

C  FNTEMP...- . Tempajry  Variable  to  hold  normal  force 

C  ANGV . Angular  Velocity  of  the  wheel 

C  SCO . Absoulute  value  of  the  longitudinal  slip 

C  FCOEF . Coefficient  relating  long  force  and  normal 

force 

C  FMAX . Maximum  force  on  tire  allowed  by  friction 

C  FTOT . Magniutude  of  the  force  on  the  tire 

C  RATIO . Ratio  between  Maximimi  and  total  force 

C  CSTIFF . Conering  Stiffness  at  the  given  point  in  the 

carpet  p 
lot 

C  (Currently  not  used  for  anything  ) 
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INTEGER  IBDY,  ICHS,  lUTIL,  ITK,  ILNG,  ISTR,  TYPE 

DOUBLE  PRECISION  RC(3),  RAD,  RR,  TD,  TK,  CALP,  STRAGL,  MU, 

&  YAW,  VX,  VY,  VZ,  TIREl,  TIRE2,  TIRE3, 

&  TIREX,  TIREY,  TIREZ,  ZROAD, 

&  DEFL,  FSPR,  FDAMP,  FNORM,  SLIP,  FLAT, 

&  S,  FLONG,  GFRC,  FRF,  PENRF, 

&  FNTEMP,  ANGV,  SCO,  FCOEF,  FMAX,  FTOT, 

&  RATIO,  ALGNTQ,  CSTIFF 

C - Functions  and  subroutines - 

DOUBLE  PRECISION  FSPLIN,  CUBIC,  CUBICl,  CARPET 

EXTERNAL  FSPLIN,  CUBIC,  CUBICl,  CARPET 

INTRINSIC  DABS,  DSIGN,  DCOS,  DSIN,  DATAN2, 

&  DSQRT,  DMAXl 

C=— ■■=■  ==Pr oce s  s  Block- -  — -  - -  - . . — 

C - Initialize  the  output  quanities  to  zero  in  case  wheel  is  off  ground 


FLONG 

O.ODO 

/* 

Tire  Longitudinal  force 

GFRC 

= 

O.ODO 

/* 

turning  wheel  torque 

FLAT 

O.ODO 

/* 

Tire  Lateral  force 

ALGNTQ 

O.ODO 

/* 

Aligning  Torque 

FSPR 

O.ODO 

/* 

Tire  Spring  Force 

FDAMP 

O.ODO 

/* 

Tire  Damping  Force 

FNORM 

« 

O.ODO 

/* 

Total  Normal  Force 

FRF 

as 

O.ODO 

/* 

Run  Flat  Force 

PENRF 

ar 

O.ODO 

/* 

Penetration  into  run  flat 

SLIP 

s= 

O.ODO 

/* 

Lateral  Slip 

S 

- 

O.ODO 

/* 

Longintudinal  Slip 

C - Calculate  the  tire-spring  deflection. 

C  Difference  between  road  elevation  and  tire  bottom  elevation 
C  Ground  penetration  if  DEFL  >  0.0 

C  Wheel  off  the  ground  if  DEFL  <=0.0 

TIREZ  =  TIR(20,I) 

ZROAD  =  TIR(21,I) 

DEFL  =  ZROAD  -  TIREZ 

C - Calculate  the  normal  force  from  ground  if  the  wheel  has  deflected 

C  into  the  ground.  If  the  tire  is  not  deflected  there  are  no 
C  forces  on  the  tire,  skip  to  the  end 

IF  (  DEFL  .LE.  O.ODO  )  THEN 
DEFL  =  O.ODO 
GOTO  1000 
ENDIF 
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C - The  wheel  has  penetrated  the  ground  so  we  must  calculate  tire  forces 


C - Get  variables  from  ITIR  and  TIR  arrays 


c 

IBDY 

ITIR (1,1) 

/* 

Body  number  wheel  is  attached  to 

ICHS 

ITIR (2,  I) 

/* 

Body  number  defined  as  the  chassis 

lUTIL 

= 

ITIR(3,I) 

/* 

Utility  curve  number 

ITK 

= 

ITIR(4,1) 

/* 

Vertical  Spring  rate  Curve  number 

ILNG 

= 

ITIR(5,1) 

/* 

Torque  Curve  number 

ISTR 

ITIR(6,I) 

/* 

Steer  Cuirve  number 

c 

TYPE 

=s 

ITIR(7,I) 

/* 

Model  type 

c 

RC(1) 

TIR(1,I) 

/* 

Wheel  center  postion  in  local 

coordinates 

C 

RC(2) 

= 

TIR(2,I) 

C 

RC(3) 

TIR(3,I) 

RAD 

= 

TIR(4,I) 

/* 

Tire  Radius 

RR 

= 

TIR(5,I) 

/* 

Rolling  Resistance 

TD 

TIR(6,I) 

/* 

Tire  Damping  constant 

TK 

TIR(7,I) 

/* 

Tire  Vertical  Spring  Stiffness 

CALP 

=5 

TIR(8,I) 

/* 

Lateral  Stiffness  of  the  tire 

C 

STRAGL= 

TIR(9,I) 

/* 

Steer  aingle 

MQ 

= 

TIR(10,I) 

/* 

Friction  Coefficient 

C 

YAW 

=s 

TIR  (11, 1) 

/* 

Yaw  cingle  of  the  wheel  body 

VX 

=: 

TIR(12,I) 

/* 

Velocity  of  wheel  center  in  road 

system 

VY 

=: 

TIR  (13, 1) 

VZ 

sa 

TIR  (14, 1) 

C 

TIREl 

=: 

TIR(15,I) 

/* 

Global  position  of  the  tire  center 

C 

TIRE2 

— 

TIR  (16, 1) 

C 

TIRE3 

=s 

TIR  (17, 1) 

C 

TIREX 

= 

TIR(18,I) 

/* 

Global  postion  of  the  tire  bottom 

C 

TIREY 

s- 

TIR  (19, 1) 

C 

TIREZ 

ss 

TIR (20, 1) 

C 

ZROAD 

ss 

TIR  (21, 1) 

/* 

Ground  Elevation 

C - Define  the  normal  force,  test  for  a  constant  spring  or  curve  data 

IF  (  ITK  .EQ.  0  )  THEN  i  /*  No  Spring  Curve 

defined 

FSPR  =  TK  *  DEFL  /*  Tire  Stiffness 

ELSE 

FSPR  =  FSPLIN  (  DEFL,  O.DO,  ITK,  1,  A,  lA,  0,  0  ) 

ENDIF 


C - Define  potential  energy  for  static  analysis 

IF  (  MSTAT  .LE.  1  )  THEN 
IF  (  ITK  .EQ.  0  )  THEN 

V  =  V  +  TK  *  DEFL**2  /  2.0D0 
ELSE 

V  =  V  +  FSPLIN  (  DEFL,  O.DO,  ITK,  1,  A,  lA,  -1,  0  ) 
ENDIF 

ENDIF 
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C - Define  the  normal  force  resulting  from  tire  damping 

FDAMP  =  -VZ  *  TD  *  CUBICl (DEFL)  /*  Tire  Damping  force 

C - The  radius  of  the  run  flat  assembly  is  given  by  (RFRAD) 

C  Add  1  inch  to  this  radius  to  account  for  tire  carcuss  thiclcness 
C  Check  to  see  if  the  tire  has  deflected  into  the  run  flat  assembly 
C  If  TRUE,  then  add  additional  forces 

C  Run  flat  stiffness  is  stored  in  RFSTIF 

C  Run  flat  damping  is  stored  in  RFDAMP 

C  Use  cubicl  with  a  tolerance  of  plus  on  minus  1/16  inch 

PENRF  =  RFRAD  +  l.ODO  +  0.0625D0  -  (RAD-DEFL)  /*  Run  flat 

penetration 

IF  (  PENRF  .GT.  O.ODO  )  THEN 

FRF  =  RFSTIF  *  PENRF  *  CUBICl (8 . 0D0*PENRF) 

&  +  RFDAMP  *  (-VZ)  *  CUBIC1(8.0D0*PENRF)  /*  Run  flat 

force 

FRF  =  DMAXl (O.ODO, FRF) 

ELSE 

PENRF  =  O.ODO  /*  Reset  for 

reporting 

FRF  =  O.ODO 
ENDIF 

C - Sum  up  all  the  forces  that  may  act  on  the  tire 

C  Limit  the  normal  force  so  that  it  can  not  go  negative 

FNORM  =  FSPR  +  FDAMP  +  FRF  /*  Normal  force  on 

tire 

FNORM  =  DMAXl (O.ODO, FNORM) 

C - If  the  tire  is  off  the  ground  there  are  no  longitudinal  forces, 

C  lateral  forces,  or  torques  turning  the  wheel. 

C  else  if  the  tire  has  penetrated  the  ground  then  calculate  the 
C  tire  slip  angle. 

IF  (  DSQRT  (  VX*VX  +  VY*VY  )  .GT.  l.D-2  )  THEN 
SLIP  =  -DATAN2  (VX,  VY) 

ELSE 

SLIP  =  O.DO 
ENDIF 

Velocity  in  X_Y  plane  for  driver  model: 

DMVELC  =  SNGL (DSQRT (QD(1,ICHS)**2  +  QD (2, ICHS) **2)  /  12.) 

C 

C - For  the  Front  tires  use  the  Lateral  Force  Data  and  Aligning  Torque 

C  Date  from  the  first  data  arrays 

IF  (  I  .EQ.  1  .OR.  I  .EQ.  2  )  THEN  /*  Front  Tires 

C - Save  the  normal  force  in  a  temporary  variable 
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C  Calculate  lateral  force  from  the  carpet  plot 

C  Carpet  plot  is  a  family  of  normal  force  Curves  versus  slip  angle 

FNTEMP  =  FNORM 

FLAT  =  CARPET (  DABS (SLIP) ,  DABS (FNTEMP) ,  I,  SFRC1(1,1)/ 

&  ALREFl(l),  FZREFl(l),  IPAl  (1) ,  IPFl(l), 

&  NAPNTl,  NFPNTl,  NTR,  CSTIFF  ) 

FLAT  =  DSIGN (FLAT, SLIP) 

C 

C  Cornering  Stiffness  and  vertical  tire  load  updates  (front  axle) : 

C  (for  driver  model) 

C 

IF(I,EQ.l)  THEN 

CCAFl  =  SNGL(CSTIFF) 

FFZLl  =  SNGL (FNORM) 

ELSE 

CCAF2  =  SNGL (CSTIFF) 

FFZL2  =  SNGL (FNORM) 

ENDIF 

C — -Calculate  alinging  torque  from  carpet  plot 

ALGNTQ  =  CARPET  (  DABS (SLIP) ,  DABS (FNTEMP) ,  I,  ALTORl(l,l), 

&  SANGLEl(l),  FZl(l),  IPSAl(l),  IPFZl(l), 

&  NSAl,  NFZl,  NTR,  CSTIFF  ) 

ALGNTQ  =  DSIGN (ALGNTQ, SLIP) 

END  IF 

C - For  the  Rear  tires  use  the  Lateral  Force  Data  and  Aligning  Torque 

C  Date  from  the  second  data  arrays 

IF  (  I  .EQ.  3  .OR.  I  .EQ.  4  )  THEN  /*  Rear  Tires 

C - Save  the  normal  force  in  a  tenporary  variable 

C  Calculate  lateral  force  from  the  Ccirpet  plot 

C  Carpet  plot  is  a  family  of  normal  force  Curves  versus  slip  angle 

FNTEMP  =  FNORM 

FLAT  =  CARPET (  DABS (SLIP),  DABS (FNTEMP) ,  I,  SFRC2(1,1), 

&  ALREF2(1)  ,  FZREF2(1),  IPA2(1),  IPF2(1), 

&  NAPNT2,  NFPNT2,  NTR,  CSTIFF  ) 

FLAT  =  DSIGN (FLAT, SLIP) 

C 

C  Cornering  Stiffness  and  vertical  tire  load  updates  (rear  axle) : 

C  (for  driver  model) 

C 

IF(I.EQ.3)  THEN 

CCARl  =  SNGL (CSTIFF) 

FFZL3  =  SNGL (FNORM) 

ELSE 

CCAR2  =  SNGL (CSTIFF) 

FFZL4  =  SNGL (FNORM) 

ENDIF 

C 
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C - Calculate  alinging  torque  from  carpet  plot 

ALGNTQ  =  CARPET (  DABS (SLIP),  DABS (FNTEMP) ,  I,  ALTOR2(l,l), 

&  SANGLE2(1),  FZ2(1),  IPSA2(1),  IPFZ2(1), 

&  NSA2,  NFZ2,  NTR,  CSTIFF  ) 

ALGNTQ  =  DSIGN (ALGNTQ, SLIP) 

END  IF 

C - Define  the  longitudinal  force  for  the  turning  wheel  model 

C  Get  local  velocity  in  the  steer  direction 

C  Get  the  angular  velocity  of  the  wheel;  Postive  velocity  is  in  the 
C  the  negative  Y  direction 

C  Defn:  Long  Slip  =  (  Velocity  -  R*W  )  /  Velocity 

C  if  Vel  >  R*w  then  slip  >0.0  Wheel  is  turning  to  slow  causing 
slip 

C  if  Vel  =  R*w  then  slip  =0.0 

C  if  Vel  <  R*w  then  slip  <0.0  Wheel  is  turning  to  fast  causing 

slip 

ANGV  =  UDE (  I+NTR  )  /*  Angular  velocity  of 

wheel 

IF  (  DABS(VY)  .GT.  O.OOOIDO  )  THEN 

S  =  (  VY  +  ANGV* (RAD-DEFL) )  /  VY  /*  Definition  of  Long. 

Slip 

ELSE 

S  =  O.DO 
END  IF 

SCO  =  DABS (  S  )  /*  temporary  variable 

IF  (  SCO  .GT.  l.DO  )  SCO=l.D0  /*  Limit  slip 

C - The  Utility  spline  curve  is  used  for  calculating  slip. 

C  Longitudinal  force  =  Fcoef  *  Fnorm 

FCOEF  =  FSPLIN  (  SCO,  O.DO,  lUTIL,  1,  A,  lA,  0,  0  ) 

FLONG  =  -DSIGN  (  FCOEF*FNORM,  S  ) 

C - Limit  the  long,  and  lateral  forces  using  the  friction  ellipse 

(circle) . 

FMAX  =  MU*DABS  (FNORM) 

FTOT  =  DSQRT (FLONG**2  +  FLAT**2) 

IF  (  FTOT  .GT.  FMAX  )  THEN 
RATIO  =  FMAX/FTOT 
FLAT  =  RATIO*FLAT 
FLONG  =  RATIO*FLONG 
END  IF 

C - Calculate  the  torque  due  to  the  longitudinal  force  causing  the  wheel 

C  to  turn 

GFRC  =  FLONG  *  (  RAD-DEFL  ) 

1000  CONTINUE 
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C - Save  values  in  ITIR  and  TIR  arrays 


TIR(22,I)  =  DEFL 
Penetration 

TIR (23, 1)  =  FSPR 
TIR(24,I)  =  FDAMP 
TIR(25,I)  =  FNORM 
TIR(26,I)  =  SLIP 
TIR (27, I)  =  FLAT 
TIR(28,I)  =  S 
TIR(29,I)  =  FLONG 
TIR(30,I)  =  GFRC 
TIR(31,I)  =  PENRF 
TIR(32,I)  =  FRF 
TIR  (33, 1)  =  ALGNTQ 

RETURN 

END 

C 


/*  Tire  Deflection  -  Ground 

/*  Spring  Force 

/*  Damping  Force 

/*  Normal  Force 

/*  Tire  Slip 

/*  Lateral  force 

/*  Longitudinal  slip 

/*  Longitudinal  force 

/*  Wheel  torque 

/*  Penetration  into  run  flat 

/*  Force  due  to  run  flat 

/*  Aligning  Torque 


E-19 


c 

SUBROUTINE  FILTER (TIME,  KNOW,  YNOW,  VNOW,  ANOW,  YLAST,  VLAST, 
1  ALAST,  XLAST,  TLAST) 

★ 

*  Second  Order  Filter: 

* 

*  TIME . current  time  (sec) 

*  KNOW . current  input  signal  to  be  filtered  (input) 

*  YNOW . filtered  value  of  XNOW  signal  (output) 

*  VNOW . first  derivative  of  YNOW  (output) 

*  ANOW . second  derivative  of  YNOW  (output) 

*  YLAST. . . .value  of  YNOW  at  last  filter  computation  (input) 

*  VLAST. . . .value  of  VNOW  at  last  filter  computation  (input) 

*  ALAST. . . .value  of  ANOW  at  last  filter  computation  (input) 

*  XLAST. . . .value  of  XNOW  at  last  filter  computation  (input) 

*  TLAST. .. .value  of  TIME  at  last  filter  computation  (input) 

* 

*  Set  Filter  cutoff  frequency  amd  damping: 

* 

WN  =  25.0 
ZETA  =  0.707 

* 

*  UPDATE  RETURN  VALUES  FRO!  LAST  ENTRY  IN  CASE  OF  T<=0  RETURN 

★ 

YNOW  =  YLAST 
VNOW  =  VLAST 
ANOW  =  ALAST 

* 

*  INITIALIZE  FOR  TIME  ZERO 

* 

IF (TIME  .LE.  0.0)  THEN 
YLAST  =  XNOW 
VLAST  =0.0 
XLAST  =  XNOW 
TLAST  =0.0 
YNOW  =  XNOW 
VNOW  =0.0 
ANOW  =0.0 

END  IF 

* 

T  =  TIME  -  TLAST 

* 

IF(T  .LE.  0.0)  RETURN 

* 

* 

*  COMPUTE  CONSTANTS  IN  RECURSION  EXPRESSIONS 

* 


Cl  =  4.+  4.*T*ZETA*WN  -  T*T*WN*WN 
C2  =  4.*T 
C3  =  T*T*WN*WN 

DET  =  4 . * (1+T*ZETA*WN) +WN*WN*T*T 
C4  =  -4.*T*WN*WN 
C5  =  4.-4.*T*ZETA*WN-T*T*WN*WN 
C6  =  2.*T*WN*WN 
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*  CALCULATE  FILTERED  VALUES  OF  DISPLACEMENT,  VELOCITY,  AND  ACCEL: 

* 

YNOW  =  (  C1*YLAST  +  C2*VLAST  +  C3* (XNOW+XLAST)  )  /  DET 
VNOW  =  (  C4*YLAST  +  C5*VLAST  +  C6* (XNOW+XLAST)  )  /  DET 
ANOW  =  (WN*WN)  *  (XNOW  -  YNOW)  -  (2 . 0*ZETA*WN)  *VNOW 

* 

* 

*  UPDATE  VALUES  FOR  NEXT  ENTRY  PRIOR  TO  RETURNING 

★ 

YLAST  =  YNOW 
VLAST  =  VNOW 
XLAST  =  XNOW 
ALAST  =  ANOW 
TLAST  =  TIME 

★ 

RETURN 

END 
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Auxilliary  routine  used  to  calculate  Euler  angles  &  position 
information  and  write  results  to  an  external  file.  Output  used  by 
by  post  processing  software  for  animation. 

SUBROUTINE  EtrLANG(T,  Y,  A) 

DOUBLE  PRECISION  A (3,3) ,  Y(3),  T,  BOT,  TLAST 
DOUBLE  PRECISION  PSI,  THETA,  PHI 
SAVE  lOPEN,  TLAST 

IF(T  .LE.  0.02)  THEN 
TLAST  =  O.-O 
lOPEN  =  0 

ENDIF 

IF(T-TLAST  .LE.  0.0495)  RETURN 
Heading  Angle 

PSI  =  DATAN2(  A (1,2),  A (2, 2)  ) 

C  Pitch  Angle 

BOT  =  DSQRT(  A (1, 2) *A (1, 2)  +  A (2, 2) *A (2, 2)  ) 

THETA  =  DATAN2(  A (3, 2),  BOT) 

C  Roll  Angle 

BOT  =  DSQRT(  A(l,l)  *A(1,1)  +  A  (2, 1)  *A  (2, 1)  ) 

PHI  =  -DATAN2(  A  (3,1),  BOT) 

C 

IF(IOPEN  .EQ.  0)  OPEN(35,  FILE='DADS.ANIM' ,STATUS='UNKNOWN’ ) 
lOPEN  =  1 

WRITE (35, 100)  Y, PSI, THETA, PHI 
100  FORMAT (6F12. 4) 

C 

TLAST  =  T 

RETURN 

END 
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Appendix  F 

Path  Planning  /  Obstacle  Detection 

Example  Code 
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This  appendix  contains  example  FORTRAN  code  that  was  used  to  demonstrate  the  path 
planning  and  obstacle  detection  algorithm  discussed  in  section  5.9.  The  code  is  only 
minimally  documented  but  may  be  helpful  as  an  outline  and  starting  point  for  other  studies 
interested  in  using  and  interfacing  the  driver  model  code. 

The  code  also  contains  a  linear  vehicle  model  with  3  degrees  of  freedom  which  may  be 
instractive,  by  example,  for  persons  interested  in  altering  or  extending  the  vehicle  dynamics 
portion  of  the  driver  model  to  other  types  of  vehicles  or  applications. 

Below  is  a  brief  oudine  of  the  code  that  follows; 

•  read  in  vehicle  parameters  for  a  3-DOF  vehicle  model  (yaw,  lateral 
displacement,  and  roll  motion) 

•  read  in  left /right  boundary  tables  and  obstacle  positions 

•  within  the  integration  loop: 

•  calculate  r(theta)  profiles  relative  to  current  vehicle  position  and 
orientation 

•  calculate  r*,  theta*  &  transform  to  x*,  y*  inertial  coordinates  as  the 
"input  path"  (target  point)  for  the  single-point  driver  model 

•  calculate  a  new  preview  time  based  upon  r*  and  forward  speed 

•  update  the  transition  matrix  for  the  new  preview  time 

•  pass  x*,y*  to  the  driver  model  and  obtain  a  steering  command 

•  integrate  the  linear  equations  of  motion  and  obtain  a  new  state 

•  end  of  the  integration  loop 

•  stop 
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C  ***  Driver  Model  -  Main  Calling  Program  *** 

C  ***  Path  Planning  /  Obstacle  Detection  Example  Code  *** 

C 

PROGRAM  MAIN 

SAVE 

INTEGER  R,  W 
C 

REAL  OBST(3,3) 

REAL  LB(99,2),  RB(99,2) 

REAL  RLB(99),  THLB(99) 

REAL  RRB(99),  THRB(99) 

REAL  RD(200),  TH(200) 

REAL  PHICOF(3,3) 

C 

CHARACTER*.80  TITLE 
COMMON  /ERDINF/  TITLE 

SAVE  /ERDINF/  - 

COMMON  /DRIV/  CAF,  GAR,  WHBS,  WF,  WR,  U 
SAVE  /DRIV/ 

COMMON  /ROLL/  HRC,  ROLLK,  ROLLC,  RIROLL 
SAVE  /ROLL/ 

COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

CCMdON  /TIRE/  FY1L,FY1R,FY2L,FY2R 
SAVE  /TIRE/ 

COMMON  /DRVSTl/  GRAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  RM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(100,2),  XT (100),  YT(IOO) 

SAVE  /DRVSTl/ 

DIMENSION  Y(7),  YD (7) 

DATA  IERD/8/ 

C 

GRAV  =  32.16666 
R  =  1 
W  =  2 

OPEN  (R, FILE= ' DMOBST .IN') 

OPEN  (W, FILE= ' DMOBST . OUT ' ) 

OPEN  (6,FILE='OUT.6') 

OPEN  (7,FILE='OUT.7' ) 

READ (R,  3)  TITLE 
3  FORMAT  (A80) 

Read  vehicle  &  simulation  parameters: 

READ  (R,10)  CAF,  CAR,  WGHT,  U,  A,  B,  RI 
READ  (R,10)  HRC,  ROLLK,  ROLLC,  RIROLL 
READ  (R,10)  TEND,  DT,  DTPR 
10  FORMAT  (7F10.3) 


RM  =  WGHT  /  GRAV 
WHBS  =  A  +  B 
WF  =  WGHT  *  B  /  WHBS 
WR  =  WGHT  *  A  /  WHBS 
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Call  DRIVEl  to  read  driver  model  parameters  &  initialize 
CALL  DRIVEl  (DFW) 

Read  in  left  &  right  boundary  tables,  obstacle  positions, 
and  initial  vehicle  location 

CALL  GETBOU(LB,  RB,  NLBO,  NRBO,  VEHWID) 

CALL  GETOBS (NOBST,  OBST,  VEHWID) 

CALL  GETPAR(THMAX,  RMAX,  DELTH,  DELR,  NPOWER) 


Call  TRANS  to  Calculate  Initial  Transition  Matrix 
CALL  TRANS 

A1  =  -2.  *  (CAF  +  CAR)  /  RM  /  U 

B1  =  2.  *  (CAR*B  -  CAF*A)  /  RM  /  U  -  U 

A2  =  2.  *  (CAR*B  -  CAF*A)  /  RI  /  U 

B2  =  -2.  *  (CAR*B*B  +  CAF*A*A)  /  RI  /  U 

Cl  =  2.  *  CAF  /  RM 

C2  =  2.  *  CAF  /  RI  *  A 

AO  =  HRC 

D1  =  HRC 

B3  =  (WF+WR) /GRAV*HRC*U/RIROLL 

B4  =  (- (WF+WR) *HRC  +  ROLLK)  /  RIROLL 

B5  =  ROLLC  /  RIROLL 

Initialization  of  state  (3-DOF  vehicle  model:  lateral,  yaw,  roll)  -> 


Y(l) 

lateral  inertial  position 

Y(2) 

lateral  velocity  in  body  axis  system 

Y(3) 

yaw  rate 

Y(4) 

yaw  angle 

Y(5) 

longitudinal  inertial  position 

Y(6) 

roll  rate 

Y(7) 

roll  angle 

DO 

20  I  =  1,  7 

Y(I)  =  0.0 
YD(I)  =  0.0 
20  CONTINUE 
YD(5)  =  U 

DFWOLD  =0.0 
DFWOUT  =0.0 

lEND  =  INT(TEND/DT  +  0.00001) 

Start  of  Integration  Loop: 

DO  30  I  =  0,  lEND 
T  =  I  *  DT 

State  Velocity:  YD(1) 
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YD(1)  =  Y(2)  +  U  *  Y(4)  +  A0*Y(7) 

C 

C  Current  vehicle  position  and  heading: 

C 

XV  =  Y(5) 

YV  =  Y(l) 

PSI  =  Y(4) 

C 

C  No  of  pts  in  left  and  right  boundary  tables 
C 

NLB  =  NLBO 
NRB  =  NRBO 
C 

C  Transform  x,y  boundary  aind  obstacle  data  to  polar  coords: 

C 

CALL  TRPOLR(XV,  YV,  PSI,  LB,  NLB,  RLB,  THLB,  0) 
CALL  MONO (NLB,  THLB,  RLB) 

CALL  TRPOLR(XV,  YV,  PSI,  RB,  NRB,  RRB,  THRB,  1) 
CALL  MONO (NRB,  THRB,  RRB) 

C 

DO  25  J=l,NOBST 

CALL  TRANOB(XV,  YV,  PSI,  OBST,  PHICOF,  J) 

25  CONTINUE 
C 

C  Ray  tracing  to  calculate  boundary/obstacle  intersects: 

C 

CALL  GENRAY(XV,  YV,  PSI,  NLB,  RLB,  THLB,  NRB,  RRB, 

+  NOBST,  PHICOF,  THMAX,  RMAX,  DELTH,  DELR,  RD,  TH) 

C 

C  Calculate  r*  from  r (theta)  profile  returned  by  GENRAY: 

C 

CALL  CALCRS(RD,  TH,  THMAX,  DELTH,  RSTAR) 

C 

C  Calculate  theta*: 

C 

CALL  CALCTH(RD,  TH,  THMAX,  DELTH,  NPOWER,  THSTAR) 

C 

C  Transform  polar  r*,  theta*  coords  to  inertial  x*,  y*  coords: 

C  (save  x*,y*  as  single-point  target  for  driver  model) 

C 

CALL  TRANXY(XV,  YV,  PSI,  RSTAR,  THSTAR,  XSTAR,  YSTAR) 

C 

C  Adjust  driver  model  preview  time  based  upon  r*  and  forward  speed 
C 

TFF  =  RSTAR  /  U 
C 

C  Update  driver  model  transition  matrix  for  current  preview  time: 

C 

CALL  TRANS 
C 
C 

C  Call  to  Driver  Model:  returns  calculated  steer  angle,  DFW. 

C 

CALL  STEER  (T,  Y,  DFWOUT,  DFWOLD,  XSTAR,  YSTAR) 
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Optional  screen  output: 

WRITE (9, 999)  T, (Y (JK) , JK=1, 7) ,DFWOLD,DFWOUT 
999  FORMAT (10F8. 2) 

DFW  =  DFWOUT 
DFWOLD  =  DFWOUT 

State  Derivatives : 


YD  (2)  =  A1  *  Y(2)  +  B1  *  Y(3)  +  Cl  *  DFW 

YD  (3)  =  A2  *  Y(2)  +  B2  *  Y(3)  +  C2  *  DFW 

YD(4)  =  Y(3) 

YD(5)  =  U 
YD(6)  =  Y(7) 

YD  (7)  =  -B3*(Y(3)  +  YD(2)/U)  -  B4*Y(6)  -  B5*Y(7) 

State  Position:  Y(i) 

Y(l)  =  Y(l)  +  YD(1)  *  DT 
Y(2)  =  Y(2)  +  YD  (2)  *  DT 
Y(3)  =  Y(3)  +  YD  (3)  *  DT 
Y(4)  =  Y(4)  +  YD(4)  *  DT 
Y(5)  =  Y(5)  +  YD(5)  *  DT 
Y(6)  =  Y(6)  +  YD(6)  *  DT 
Y(7)  =  Y(7)  +  YD(7)  *  DT 

FYIL  =  -CAF*(  (Y(2)+Y(3)*A)/U  -  DFW  ) 

FYIR  =  -CAF*(  (Y(2)+Y(3)*A)/U  -  DFW  ) 

FY2L  =  -CAF*(Y(2)-Y(3)*B)/U 

FY2R  =  -CAF*(Y(2)-Y(3)*B)/U 

Call  Output  Subroutine  to  Print  Results  (optional) 

CALL  OUT(T,  Y,  YD,  DFW) 

Call  ERD  plotter  routines:  (optional) 

IF(T  .EQ.  0.0)  THEN 


CALL 

SETERD (lERD, 

NBYTES) 

CALL 

ELSE 

OUTERD(IERD, 

NBYTES, 

T, 

Y,  YD, 

DFWOUT, 

DFW, 

DFVEL, 

DFACC) 

CALL 

ENDIF 

OUTERD (lERD, 

NBYTES, 

T, 

Y,  YD, 

DFWOUT, 

DFW, 

DFVEL, 

DFACC) 

End  of  Integration  Loop: 

30  CONTINUE 

CLOSE  (R) 

CLOSE  (W) 

CLOSE  (6) 

CLOSE  (7) 

READ  (9,40)  ISTOP 
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40  FORMAT  (II) 

STOP 

END 

C 

C  ***  End  of  Main  Calling  Program  *** 

C 

C 

C  ***  Output  Siibroutine  *** 

C 

SUBROUTINE  OUT(T,  Y,  YD,  DFW) 

SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE  /DRIV/ 

DIMENSION  Y (7) ,  YD (7) ,  YOUT(7),  YDOUT(7) 

DATA  RADIAN  /57.3/ 

DO  10  I  =  1,  7 
YOUT(I)  =  Y(I) 

YDOUT(I)  =  YD(I) 

10  CONTINUE 

YOUT(2)  =  Y(2)  /  U  *  RADIAN 
YOUT(3)  =  Y(3)  *  RADIAN 
YOUT(4)  =  Y(4)  *  RADIAN 
YOUT(6)  =  Y(6)*RADIAN 
YOUT(7)  =  Y(7)*RADIAN 
YDOUT(2)  =  YD(2)  /  U  *  RADIAN 
YDOUT(3)  =  YD (3)  *  57.3 
YDOUT(4)  =  YD (4)  *  RADIAN 
DFWPRT  =  DFW  *  RADIAN 

WRITE  (W,20)  T,  DFWPRT,  (YOUT (I) , 1=1, 7) ,  (YDOUT (I) , 1=1, 5) 
20  FORMAT  (14F8.2) 

RETURN 

END 


Starf  of  Driver  Model  Routines  *** 


***  Driver  Model  Subroutine  *** 

Initialization 

SUBROUTINE  DRIVEl (DFW) 

SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

COMMON  /DRTV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE  /DRTV/ 

COMMON  /DRVSTl/  GRAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  RM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(100,2),  XT (100),  YT(IOO) 

SAVE  /DRVSTl/ 
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GRAV  =  32.16666 
TICYCL  =  0.0001 
TSS  =  0.0 
DMAX  =  0.2 

WRITE  (W,10) 

10  FORMAT  ('O',  T20,  'CLOSED-LOOP  PATH  FOLLOWING  MODE',  /,  'O',  T20, 

1  'X-Y  ',  'PATH',  '  COORDINATES  :',  /,  'O',  T50,  'X',  T60, 

2  'Y',  /,  /'O',  T47,  '(FEET)',  T57,  '(FEET)') 

READ  (R,20)  NP 
20  FORMAT  (13) 

DO  40  J  =  1,  NP 

READ  (R,30)  XP(J),  YP  ( J) 

30  FORMAT  (2F10.2) 

WRITE  (W,50)  XP(J),  YP(J) 

40  CONTINUE 

50  FORMAT  ('  ',  T43,  2F10.2) 

READ  (R,60)  TAUMEM,  TFF 
60  FORMAT  (F10.4) 

WRITE  (W,70)  TAUMEM,  TFF 

70  FORMAT  ('  ',  /,  '  ',  T20,  'DRIVER  TRANSPORT  LAG  (SEC)  :',  T60, 

1  F4.2,  /,  '  ',  T20,  'END  OF  PREVIEW  INTERVAL  (SEC)  :',  T60, 

2  F4.2/) 

RM  =  (WF  +  WR)  /  GRAV 
B  =  WHBS  *  WF  /  (WF  +  WR) 

A  =  WHBS  -  B 
RI  =  A  *  B  *  RM 
PSIO  =0.0 


NTF  =  1 


DO  80  J  =  1,  NP 

XT(J)  =  XP(J)  *  COS  (PSIO)  +  YP(J)  *  SIN  (PSIO) 
YT(J)  =  -XP(J)  *  SIN  (PSIO)  +  YP(J)  *  COS  (PSIO) 
80  CONTINUE 
TLAST  =  0. 

DFWLST  =  0. 

TILAST  =  0. 

DFW  =  0. 

DO  90  I  =  1,  100 
DMEM(I,1)  =  0. 

90  DMEM(I,2)  =  -1. 

RETURN 

END 

Transition  Matrix  Calculation 

SUBROUTINE  TRANS 
SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
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SAVE  /INOUT/ 

COMMON  /DRIV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE  /DRIV/ 

COMMON  /ROLL/  HRC,  ROLLK,  ROLLC,  RIROLL 
SAVE  /ROLL/ 

COMMON  /DRVSTl/  GRAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  BM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(100,2),  XT (100),  YT(IOO) 

SAVE  /DRVSTl/ 

COMMON  /TRSSTR/  TTT(6,6,10),  TTTl (6, 6, 10) ,  G(6) 

SAVE  /TRSSTR/ 

DIMENSION  SV(6),  SD(6),  SVI  (6) 

DELT  =0.01 
GRAV  =  32.16666 

A1  =  -2.  *  (CAF  +  CAR)  /  RM  /  U 

B1  =  2.  *  (CAR*B  -  CAF*A)  /  RM  /  U  -  U 

A2  =  2.  *  (CAR*B  -  CAF*A)  /  RI  /  U 

B2  =  -2.  *  (CAR*B*B  +  CAF*A*A)  /  RI  /'U 

Cl  =  2.  *  CAF  /  RM 

C2=2.*CAF/RI*A 

AO  =  HRC 

D1  =  HRC 

B3  =  (WF+WR)VGRAV*HRC*U/RIROLL 

B4  =  (- (WF+WR) *HRC  +  ROLLK)  /  RIROLL 

B5  =  ROLLC  /  RIROLL 

ULAST  =  U 

G(l)  =  0. 

G(2)  =  Cl 
G(3)  =  C2 
G(4)  =  0. 

G(5)  =  0. 

G(6)  =  0. 

DO  70  J  =  1,  6 

NBEG  =  TSS  /  DELT  +  1 

NENDl  =  (TFF  +  .001  -  TSS)  /  NTF  /  DELT 
NENDV  =  NENDl 
DO  10  L  =  1,  6 
SV(L)  =  0.0 
SVI(L)  =0.0 
10  CONTINUE 
TIME  =  0. 

SV(J)  =1.0 
DO  60  I  =  1,  NTF 

DO  40  K  =  NBEG,  NENDV 

SD(1)  =  SV(2)  +  U  *  SV(4)  +  A0*SV(6) 

SD(2)  =  A1  *  SV(2)  +  B1  *  SV(3) 

SD(3)  =  A2  *  SV(2)  +  B2  *  SV(3) 

SD(4)  =  SV(3) 

SD(5)  =  SV(6) 

SD(6)  =  -B3  *  (SV(3)  +  SD(2)/U)  -  B4*SV(5)  -  B5*SV(6) 

DO  20  L  =  1,  6 

SV(L)  =  SV(L)  +  SD(L)  *  DELT 
20  CONTINUE 

TIME  =  TIME  +  DELT 


F-10 


oooo  o  o  ooo  ooo 


DO  30  L  =  1,  6 

SVI(L)  =  SVI(L)  +  SV(L)  *  DELT 
30  CONTINUE 

40  CONTINUE 

DO  50  L  =  1,  6 

TTT(L,J,I)  =  SV(L) 

TTT1(L,J,I)  =  SVI(L) 

50  CONTINUE 

NBEG  =  NBEG  +  NENDl 
NENDV  =  NENDV  +  NENDl 
60  CONTINUE 
70  CONTINUE 
RETURN 
END 

Closed-Loop  Steer  Calculation 

SUBROUTINE  STEER (X,  Y,  DFW,  DFWNOW,  XSTAR,  YSTAR) 

(Subroutine  "DRIVER"  in  other  versions) 

SAVE 

INTEGER  R,  W 
CCMyiON  /INOUT/  R,  W 
SAVE  /INOUT/ 

COMMON  /DRTV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE  /DRIV/ 

COMMON  /DRVSTl/  GRAV,  TICYCL,  TSS,  DMAX,  XP(IOO),  YP(IOO),  TAUMEM, 

1  TFF,  RM,  A,  B,  RI,  PSIO,  NTF,  NP,  TLAST,  DFWLST,  TILAST, 

2  DMEM(100,2),  XT (100),  YT(IOO) 

SAVE  /DRVSTl/ 

CCayMON  /TRSSTR/  TTT(6,  6,10),  TTTl  (6,  6, 10)  ,  G(6) 

SAVE  /TRSSTR/ 

DIMENSION  Y(7),  YC(7) 

DIMENSION  DUMV11(6) 

DIMENSION  DUMV1(6),  VECM(6) 

DIMENSION  DUMM1( 6, 6),  DUMM2(6,6) 

DATA  VECM  /l.O,  5*0.0/ 

NP  =  1 

XP(1)  =  XSTAR 
YP(1)  =  YSTAR 
T  =  X 

EPSI  =  ABS(Y(4)  -  PSIO) 

DO  10  I  =  1,  4 
10  YC(I)  =  Y(I) 

YC(5)  =  Y(6) 

YC(6)  =  Y(7) 

YC(7)  =  Y(5) 

IF  (EPSI  .LE.  .002)  GO  TO  30 

Update  Coordinate  Transformation 

PSIO  =  YC(4) 

DO  20  J  =  1,  NP 
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XT(J)  =  XP(J)  *  COS(PSIO)  +  YP(J)  *  SIN(PSIO) 

20  YT(J)  =  -XP(J)  *  SIN(PSIO)  +  YP(J)  *  COS(PSIO) 

C 

30  YO  =  -YC(7)  *  SIN(PSIO)  +  YC(1)  *  COS(PSIO) 

XO  =  YC(7)  *  COS(PSIO)  +  YC(1)  *  SIN(PSIO) 

YC(1)  =  YO 

YC(4)  =  YC(4)  -  PSIO 
EPSY2  =  0. 

TSUM  =  0. 

SSUM  =  0. 

IF  (T  -  TILAST  .LE.  TICYCL)  RETURN 
DO  50  I  =  1,  NTF 

TJI  =  (TFF  -  TSS)  /  NTF  *  I  +  TSS 
DO  40  J  =  1,  6 
DO  40  K  =  1,  6 

DUMM1(J,K)  ==  TTT1(J,K,I) 

40  DUMM2(J,K)  =  TTT(J,K,I) 

CALL  ©4PRD(VECM,  DUMMl,  DUMVll,  1,  6,  6) 

CALL  GMPRD(VECM,  DUMM2,  DUMVl,  1,  6,  6) 

CALL  GMPRD (DUMVl,  YC,  Tl,  1,  6,  1) 

XCAR  =  XO  +  U  *  TJI 
C 

CALL  TRAJ(XCAR,  XT,  YT,  YPATH) 

C 

YPATH  =  YT(1) 

C 

CALL  GMPRD(DUMV11,  G,  SI,  1,  6,  1) 

EP  =  Tl  +  SI  *  DFWNOW  -  YPATH 
TSUM  =  TSUM  +  EP  *  SI 
SSUM  =  SSUM  +  SI  *  SI 

EPSY2  =  EPSY2  +  EP  *  EP  *  (TFF  -  TSS)  /  NTF 
50  CONTINUE 

EPSY  =  SQRT(EPSY2)  /  (TFF  -  TSS) 

DFW  =  -TSUM  /  SSUM  +  DFWNOW 

IF  (ABS(DFW)  .GT.  DMAX)  DFW  =  DMAX  *  SIGN (1., DFW) 

DO  60  J  =  1,  2 
DO  60  I  =  1,  99 

60  DMEMdOl  -  I,J)  =  DMEMdOO  -  I,J) 

DMEM(1,1)  =  DFW 
DMEM(1,2)  =  T 
TTAB  =  T  -  TAUMEM 
DO  70  I  =  1,  99 

IF  (DMEMd  +  1,2)  .LE.  TTAB  .AND.  DMEM(I,2)  .GE.  TTAB) 

1  GO  TO  90 
70  CONTINUE 
WRITE  (W,80) 

80  FORMAT  ('O',  '*****  TAUMEM  PROBABLY  TOO  LARGE  ***★*') 

CALL  EXIT 

C  90  DFW  =DMEM(I-2,1)+DMEM(I-1,1)+DMEM(I,1)+DMEM(I+1,1)+DMEM(I+2,1) 
C  DFW  =  DFW/5. 

90  DFW  =  0.0 

IF(T  .GE.  TAUMEM)  DFW  =  DMEM(I,1) 

TLAST  =  X 
TILAST  =  X 
RETURN 
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***  Trajectory  Svibroutine  *** 

SUBROUTINE  TRAJ(X,  XT,  YT,  YPATH) 

SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

CC»^MON  /DRTV/  CAF,  CAR,  WHBS,  WF,  WR,  U 
SAVE  /DRIV/ 

DIMENSION  XT (*),  YT(*) 

SEARCH  FOR  XI,XI+1: 

DO  10  J  =  1,  99 

IF  (X  .GE.  XT(J)  .AND.  X  .LT.  XT(J  +  1))  GO  TO  30 
10  CONTINUE 
WRITE  (W,20) 

20  FORMAT  ('O',  'X-SEARCH  IN  SUB.  TRAJ  FAILED.') 

CALL  EXIT 

30  SLOPE  =  (YT(J  +  1)  -  YT(J))  /  (XT(J  +  1)  -  XT(J)) 

Y2  =  YT ( J)  +  SLOPE  *  (X  -  XT ( J) ) 

YPATH  =  Y2 

RETURN 

END 

***  Matrix  Product  Subroutine  *** 

SUBROUTINE  GMPRD (A,  B,  R,  N,  M,  L) 

DIMENSION  A  (N*M)  ,  B(M*L),  R(N*L) 

IR  =  0 
IK  =  -M 
DO  10  K  =  1,  L 
IK  =  IK  +  M 
DO  10  J  =  1,  N 
IR  =  IR  +  1 
JI  =  J  -  N  - 
IB  =  IK 
R(IR)  =  0. 

DO  10  I  =  1,  M 
JI  =  JI  +  N 
IB  =  IB  +  1 

10  R(IR)  =  R(IR)  +  A(JI)  *  B(IB) 

RETURN 

END 

***  End  of  Driver  Model  Code  *** 


***  Start  of  Path  Planning  /  Obstacle  Detection  Code 


SUBROUTINE  GETBOU(LB,  RB,  NLB,  NRB,  VEHWID) 
SAVE 

INTEGER  R,  W 


*•** 
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COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

REAL  LB (99, 2),  RB(99,2),  VEHWID 

READ (R, 100)  VEHWID 
100  FORMAT (FIO. 3) 

READ (R,  150)  NLB 
150  FORMAT (12) 

DO  200  1=1, NLB 
READ(R,50)  LB(I,1)  ,LB(I,2) 

50  FORMAT (2F1 0.3) 

LB (I, 2)  =  LB (I, 2)  +  VEHWID/2. 

200  CONTINUE 

READ (R, 150)  NRB 
DO  300  I=1,NRB 
READ(R,50)  RB(I,1)  ,RB(I,2) 
RB(I,2)  =  RB(I,2)  -  VEHWID/2. 

300  CONTINUE 

RETURN 

END 


SUBROUTINE  GETOBS (NOBST,  OBST,  VEHWID) 
SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

REAL  OBST (3,  3) 

READ (R,  100)  NOBST 
100  FORMAT (12) 

DO  200  1=1, NOBST 

READ (R,  300)  (OBST (I, J),  J=l,3) 

OBST (I, 3)  =  OBST (I, 3)  +  VEHWID/2. 

200  CONTINUE 
300  FORMAT (3F1 0.3) 

RETURN 

END 


SUBROUTINE  GETPAR(THMAX,  RMAX,  DELTH,  DELR,  NPOWER) 
SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

READ (R,  100)  THMAX,  RMAX,  DELTH,  DELR,  NPOWER 
100  FORMAT(4F10.3,I2) 

RETURN 

END 
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c 

100 


SUBROUTINE  GBTPOS (X,  Y,  PSI) 
SAVE 

INTEGER  R,  W 
COMMON  /INOUT/  R,  W 
SAVE  /INOUT/ 

READ (R, 100)  X,  Y,  PSI 
FORMAT (3F1 0.3) 

RETURN 

END 


SUBROUTINE  TRPOLR(X,  Y,  PSI,  BOUND,  NB,  RB,  THE,  LR) 
SAVE 

REAL  X,  Y,  PSI,  BOUND (99, 2),  RB(*),  THB(*) 

REAL  RHO(2,99),  ATRANS(2,2),  DUMV(2) 

DATA  PI  /3.1416/ 

C 

ATRANS(1,1)  =  COS (PSI) 

ATRANS(1,2)  =  SIN (PSI) 

ATRANS(2,1)  =  -SIN (PSI) 

ATRANS(2,2)  =  COS (PSI) 

C 

DO  100  1=1, NB 

DUMV(l)  =  BOUND (1,1)  -  X 

DUMV(2)  =  BOUND (I, 2)  -  Y 

CALL  GMPRD (ATRANS,  DUMV,  RHO(l,I),  2,  2,  1) 

RB(I)  =  SQRT(  RHO(l,I)*RHO(l,I)  +  RHO (2, I) *RHO (2, I)  ) 
IF(RHO(l,I)  .NE.  0.)  THEN 

THB(I)  =  ATAN(  RHO  (2, 1)  /  RHO  (1,1)  ) 

IF(RHO(2,I) .LT.O. .AND.  RHO (1, I) .LT. 0 . )  THB(I)  =  -PI/2 . * (-1) **LR 
IF(RHO(2,I) .GT.O. .AND.  RHO (1, 1) .LT. 0 . )  THB(I)  =  PI/2 . * (-1) **  (LR+1) 
ELSE 

THB(I)  =  PI/2. 

IF(RHO(2,I)  .LT.O.)THB(I)  =  -PI/2. 

ENDIF 

100  CONTINUE 
RETURN 


END 

C 

SUBROUTINE  TRANOB (X,  Y,  PSI,  OBST,  COEFF,  I) 

SAVE 

REAL  X,  Y,  PSI,  OBST (3, 3),  COEFF (3, 3) 

C 

COEFF  (1,1)  =  2.*(COS(PSI)*(X  -  OBST  (1,1))  +  SIN(PSI)*(Y  -  OBST  (1, 2 
+  ))) 

COEFF(I,2)  =  2.*(-SIN(PSI)*(X-OBST(I,l) )  +  COS(PSI)*(Y  -  OBST(I,2 
+  ))) 

COEFF (I, 3)  =  (X  -  OBST(I,l) )*(X  -  OBST (1,1))  +  (Y  -  OBST (I, 2))* 

+  (Y  -  OBST (I, 2))  -  (OBST (I, 3))  *  (OBST (I, 3)) 

RETURN 

END 

C 

SUBROUTINE  GENRAY (X, Y, PSI,NLB, RLB, THLB, NRB, RRB, THRB, NOBST, 

+  PHICOF,  THMAX,  RMAX,  DELTH,  DELR,  R,  TH) 
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SAVE 

REAL  X,  Y,  PSI,  RLB(*),  THLB(*),  RRB(*),  THRB(*),  PHICOF(3,3) 
+  ,R(*),TH(*) 

REAL  RADLST(200) 

SAVE  RADLST 
C 

JMAX  =  2*THMAX/DELTH+1 
THETA  =  -THMAX  -  DELTH 
DO  100  J=l,  JMAX 

THETA  =  THETA  +  DELTH 

CALL  SEARCH (1,  NLB,  THLB,  RLB,  THETA,  RNOWL,  1) 

CALL  SEARCH (1,  NRB,  THRB,  RRB,  THETA,  RNOWR,  1) 

R(J)  =  RNOWR 

IF (RNOWL  .LT.  RNOWR)  R(J)  =  RNOWL 
IF(NOBST  .GT.  0)  THEN 

RADIUS  =0.0 
ISTART  =  RADIUS/DELR 
lEND  =  RMAX/DELR 
DO  90  I=ISTART, lEND 

RADIUS  =  RADIUS  +  DELR 

CALL  EVALOB (RADIUS,  THETA,  PHICOF,  NOBST,  VALUE) 
IF (VALUE  .LT.  0)  THEN 

IF(  RADIUS  .LT.  R(J)  )  R(J)  =  RADIUS 
GO  TO  95 
ENDIF 

90  CONTINUE 

95  CONTINUE 
ENDIF 
C 

IF(  RMAX  .LT.  R(J)  )  R(J)  =  RMAX 
TH(J)  =  THETA 
C 

RADLST (J)  =  R(J) 

C 

100  CONTINUE 
C 

RETURN 

END 

C 

C 

SUBROUTINE  CALCRS (R,  TH,  THMAX,  DELTH,  RSTAR) 

SAVE 

REAL  R(*),  TH(*),  THMAX,  DELTH,  RSTAR 
C 

SUM  =0.0 
C 

IMAX  =  2*THMAX/DELTH+1 
DO  100  1=1, IMAX 

SUM  =  SUM  +  R(I) 

100  CONTINUE 

RSTAR  =  SUM  /  IMAX 
C 

RETURN 

END 

C 
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c 

SUBROUTINE  CALCTH(R,  TH,  THMAX,  DELTH,  NPOWER,  THSTAR) 
SAVE 

REAL  R(*),  TH(*),  THMAX,  DELTH,  THSTAR 
C 

SUM1=0 . 0 
SUM2=0 . 0 
C 

IMAX  =  2*THMAX/DELTH+1 
DO  100  1=1, IMAX 

SUMl  =  SUMl  +  (R(I)**NPOWER)  *  TH(I) 

SUM2  =  SUM2  +  (R(I)**NPOWER) 

100  CONTINUE 
C 

THSTAR  =  SUMl  /  SUM2 
C 

RETURN 

END 


SUBROUTINE  EVALOB(R,  THETA,  PHICOF,  NOBST,  VALUE) 

SAVE 

REAL  R,  THETA,  PHICOF (3, 3),  VALUE 
DIMENSION  VAL( 3) 

DO  100  1=1,  NOBST 

VAL (I ) =R*R+ (  PHICOF (1,1) *COS (THETA)  +  PHICOF (1,2) *SIN (THETA) ) 
+  *  R  +  PHICOF (I, 3) 

100  CONTINUE 


VALUE  =  VAL(l) 

DO  90  1=1, NOBST 

IF (VAL (I)  .LT.  VALUE)  VALUE  =  VAL (I) 
90  CONTINUE 

RETURN 

END 


SUBROUTINE  TRANXY(X,  Y,  PSI,  RSTAR,  THSTAR,  XSTAR,  YSTAR) 
SAVE 

REAL  X,  Y,  PSI,  RSTAR,  THSTAR,  XSTAR,  YSTAR 
XSTAR  =  X  +  RSTAR*COS (PSI+THSTAR) 

YSTAR  =  Y  +  RSTAR*SIN  (PSI+THSTAR) 

RETURN 

END 


SUBROUTINE  SEARCH (M,  N,  X,  Y,  A,  B,  IDIR) 

SAVE 

DIMENSION  X(*),  Y(*) 

IDIR  »  1  =>  FORWARD  SEARCH;  IDIR  =  -1  =>  REVERSE  SEARCH. 


IF (IDIR  .EQ.  -1)  GO  TO  800 
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400  CONTINUE 


C 

DO  100  I  =  M,  N-1 
B  =  Y(I) 

IF(A.EQ.X(I) )  RETURN 

IF (A  .GE.  X(I)  .AND.  A  .LT.  X(I+1))  THEN 

B  =  Y(I)  +  (Y(I+1)-Y(I))/(X(I+1)-X(I))*(A-X(I)) 
RETURN 
ENDIF 

IF(A  .LE.  X(I)  .AND.  A  .GT.  X(I+1))  THEN 

B  =  Y(I)  +  (Y(I+1)-Y(I))/(X(I+1)-X(I))*(A-X(I)) 
RETURN 
ENDIF  • 

100  CONTINUE 
B  =  Y(N) 

IF((A  .LE.  X(M))  .AND.  (X(M)  .LE.X(N)  ) )  B  =  Y  (M) 

RETURN 

REVERSE  SEARCH; 

800  CONTINUE 

DO  200  I  =  N,Mfl,-l 
B  =  Y(I) 

IF(A.EQ.X(I) )  RETURN 

IF (A  .GE.  X(I)  .AND.  A  .LT.  X(I-l))  THEN 

B  =  Y(I)  +  (Y(I-1)-Y(I))/(X(I-1)-X(I))*(A-X(I)) 
RETURN 
ENDIF 

IF (A  .LE.  X(I)  .AND.  A  .GT.  X(I-l))  THEN 

B  =  Y(I)  +  (Y(I-1)-Y(I))/(X(I-1)-X(I))*(A-X(I)) 
RETURN 
ENDIF 

200  CONTINUE 
B  =  Y(M) 

IF((A  .LE.  X(N))  .AND.  (X(N)  .LE.X(M)  )  )  B  =  Y  (N) 

RETURN 
END 


C 

C 

C 


100 


SUBROUTINE  MONO(N,  X,  Y) 
SAVE  . 

DIMENSION  X(*),  Y(*) 

IF(  X(l)  .LT.  X(N)  )  RETURN 

M  =  N/2 

DO  100  1=1, M 

DUM  =  X(I) 

X(I)  =  X(N-I+1) 
X(N-I+1)  =  DUM 

CONTINUE 
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DO  200  1=1, M 

DOM  =  Y(l) 

Y(I)  =  Y(N-I+1) 
Y(N-I+1)  =  DUM 

200  CONTINUE 
C 

RETURN 

END 
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Background  References 
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The  first  two  technical  papers  included  in  this  appendix  (references  1  and  2  firom  the  List  of 
References)  provide  principal  background  material  for  much  of  the  work  initially 
undertaken  in  this  project  and  are  included  here  as  a  convenience.  The  third  technical  paper 
appearing  in  this  appendix  reports  on  analyses  performed  by  Stribersky  (reference  42) 
using  the  HMMWV-Trailer  combination  vehicle  test  data  from  this  project  to  confirm 
findings  predicted  by  the  application  of  bifurcation  theory  to  vehicle  dynamic  systems. 

The  material  is  reproduced  here  by  permission  of  the  IEEE  Transactions  on  Sytems,  Man, 
and  Cybernetics  journal  (Copyright  IEEE ),  and,  the  ASME  Journal  of  Dynamic  Systems, 
Measurement,  and  Control  (Copyright  ASME). 
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Application  of  an  Optiinal  Preview  Control 
for  Simulation  of  Closed-Loop 
Automobile  Driving 

cn/v^ajES  c.  Macadam 


Abstract — An  optima!  preview  control  method  ts  applied  to  thb  aulcmc^ 
bile  path  following  problem.  The  technique  is  first  used  to  examine  tht 
straight-line  regulatory  driving  task  and  results  compared  witn  similar  ex¬ 
perimental  measurements.  The  method  is  further  demonstrattKl  by  closed- 
loop  simulation  of  an  automobile  driver/ vehicle  system  during  iransient 
lane-change  maneuvers.  The  computer  simulation  results  a'^e  compared 
with  equivalent  vehicle  test  measurements. 


a.  totEC)i)ile  path  following  problem  produces  substantive 
agreement  when  compared  with  driver/ vehicle  experimen 
tal  measurements  for  both  straight-line  regulatory  driving 
a:.d  transient  lane-change  maneuvers. 

II.  The  Optimal  Preview  Control 


I.  Introduction 

This  paper  presents  example  applications  (to  the 
automobile  path  following  problem)  of  a  general 
method  of  control  synthesis  presented  in  [1].  The  method  is 
demonstrated  here  by  simulation  of  a  closed-loop  automo- 
bile/driver  system  and  the  results  compared  with 
driver/ vehicle  test  measurements.  Results  for  the  cptimal 
preview  control  are  also  discussed  within  the  context  of 
manual  control  pursuit  tracking  task  findings. 

The  control  technique  demonstrated  herein  is  designed 
for  application  to  linear  time-invariant  systems  utilizing 
preview  control  strategies  for  regulation  or  tracking  tasks. 
A  common  example  of  this  type  of  control  strategy  occurs 
during  normal  automobile  path  follo^^ing  in  which  drivers 
“look-ahead”  to  follow  a  desired  path.  Human  operators, 
as  part  of  various  man- machine  systems,  typically  employ 
preview'  control  strategies  to  control  and  stabilize  such 
systems.  It  is  widely  recognized  that  human  operators  are 
capable  of  controlling  and  adapting  to  a  wide  variety  of 
dynamical  systems,  many  of  which  are  vehicles  with  pre¬ 
view-oriented  control  requirements  such  as  automobiles, 
bicycles,  and  complex  aircraft  [2]-[8].  Clearly  human  con¬ 
trol  of  most  vehicles  would  not  be  possible  without  some 
training  by  the  operator  to  acquire  an  understanding  of  the 
vehicle  response  to  various  control  inputs.  While  a  certain 
portion  of  this  training  serves  to  identify  and  remforce 
learned  open-loop  responses  for  repeated  and  familiar  con¬ 
trol  task  scenarios,  the  remainder  frequently  serves  to 
identify  and  reinforce  the  operator's  understanding  or 
“feel”  of  the  vehicle  response  to  control  inputs  continuaUy 
in  use  for  closed-loop  regulation  and/or  pursuit  needs.  It  is 
in  this  latter  control  category  for  general  linear  system 
representations  capable  of  preview  control  strategies,  that 
the  method  presented  in  [1]  can  find  particular  application. 
As  will  be  demonstrated  in  this  paper,  application  to  the 


Before  applying  the  optimal  preview  control  of  [1]  to  the 
automobile  path  following  problem,  the  main  results  and 
synibc4  definitions  contained  therein  are  briefly  reviewee 
ir  this  section  for  later  reference.  As  derived  in  [1],  for  the 
liaear  system 

X  =  fx  gu  (1 

y=-m^x  (2 

wiiere 


.(•  n  K  1  state  vector, 

V  scalar  output  related  to  the  state  by  the  «  X  1/n' 
constant  observer  vector  transpose, 

F  constant  nX  n  system  matrix, 
and 

g  constant  n  X  1  control  coefficient  vector, 

the  optimal  control  u°(t)  which  minimizes  a  special  fora 
of  the  local  performance  index, 

•^=  (3 

over  the  current  preview  interval  (t,  i  +  T)  where 


W  arbitrary  weighting  function  over  the  preview  inter 
val 
and 

/  previewed  input. 


is  given  by 
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where  I  is  the  identity  matrix.  For  the  special  cisi  ci  cririianisti.  rcca  of  the  ccinsiant  matrix 
H  I  Tj  —  t)  =  S(T^).  the  Dirac  delta  function  for  0  7"'  s; 

r.  (4)  simplifies  to  .  [  ‘  i9) 


[i+ 1 

-1  ! 

L  1 

T*m^ 

1  i. 

=  [fit^T*)-yo{t+T*)]/i'rK),  (6 


the  single-point  preview  control  version  of  (4),  wh£:i'e 
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Equation  (6)  represents  a  proportional  controller 
gain  inversely  related  to  the  preview  interval  T*  and  oper¬ 
ating  on  the  error  between  the  previewed  input  /(;  +  7'*) 
and  >’o(r  +  T*),  that  portion  of  the  previewed  output  deriv¬ 
ing  from  the  state  vector’s  current  initial  condition.  Like¬ 
wise  (4)  can  be  interpreted  as  a  proportional  controller 
operating  on  a  similar  error  averaged  and  weighted  over 
the  preview  interval  (t,t  +  T)  by  the  additional  terms 
appearing  in  (4). 

It  is  also  shown  in  [1]  that  the  optimal  solution  u°(t)  can 
be  expressed  in  terms  of  any  current  nonoptimal  u(t)  and 
correspondingly  nonzero  preview  output  error  «(r)  as 


«°(r)  =  «(/)  + 


r  ^i{T})A{rj)W{r\  -  t)cir] 

U _ _ 

-  t)dt\ 


(7) 


where 


Av)  =  {v  - 


,  ,  “  F"(7,-rr 

i,  («+!)! 


«(■»!)  =/(t?)_--  t)x{t)  -  u{t)A(^^) 


n=] 


n\ 


For  the  special  case  of  W(t]  —  t)  -  5(7*),  as  before,  (7) 
reduces  to 

■.“(.)  =  +  (8) 

The  formulation  expressed  by  (7)  can  be  useful  in  describ¬ 
ing  systems  which  do  not  achieve,  though  closely  ap¬ 
proximate.  the  defined  optimal  system  behavior.  Such  cases 
may  arise  from  limitations  in  achieving  the  precise  optimal 
control  due  to  time  lags  or  dynamic  properties  inherent  in 
the  controller  and  not  accounted  for  a  priori  in  the  optimi¬ 
sation.  The  next  two  sections  adopt  this  view  for  the 
car/ driver  man- machine  system  in  an  attempt  to  describe 
and  explain  actual  closed-loop  driving  behavior. 

Finally,  it  was  also  shown  in  [1]  that  information  con¬ 
cerning  stability  of  the  closed-loop  system  utilizing  the 
optimal  preview  control  of  (4)  or  (7)  is  provided  by  the 
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For  iJne  spsc^al  of  W  q)  =  5(T^),  f9)  becomes 


f  -  <g/rf 


^"17’*)''  1 


(r*-/:)  .  (10) 


III.  Application  to  Manual  Control  Pursuit 
^'racking  Tasks  as  Represented  by 
Straight- Line  Automobile  Driving 


The  most  well-known  and  characteristic  property  ex¬ 
hibited  by  human  operators  in  tracking  tasks  is  the  trans¬ 
port  delay  denying  from  perceptual  and  neuromuscular 
mechanisms.  By  introducing  this  inherent  delay  property  a 
posterion  in  the  optimal  preview  control  formulation,  excel¬ 
lent  agreement  can  be  demonstrated  between  typical  man¬ 
ual  control  pursuit  tracking  task  results  and  the  resulting 
optimal  preview  controller  modified  to  include  the  inherent 
transport  delay  (heretofore  referred  to  as  the  “modified” 
optimal  preview  control). 

For  reasons  of  clarity  and  notational  simplicity,  the 
discussion  in  this  section  will  make  use  only  of  (8),  the 
single-point  preview  control  version  of  (7).  Equation  (8) 
can  be  represented  by  the  block  diagram  of  Fig.  1,  where 
G{s)  =  [/i'  —  F]“'g  represents  the  controlled  element  vec¬ 
tor  transfer  function,  and  u(t),  the  current  control,  is 
related  to  the  optimal  control  u°(l)  by  a  transfer  function 
N(s)  (previously  assumed  equal  to  one  in  the  derivation  of 
the  optimal  control  m°(0)-  Th«  introduction  of  the  N(s) 
transfer  function  is  useful  in  describing  systems  which 
function  (or  are  presumed  to  do  so)  in  an  error  minimiza¬ 
tion  fashion,  but  fail  to  achieve  the  precise  optimal  control 
due  to  an  inherent  limitation  within  the  controller  or 
control  process  itself,  e.g..  delays  resulting  from  processor 
calculations  and  sample  hold  operations  in  digital  systems, 
or  perceptual/neuromuscular  lags  in  the  case  of  a  human 
controller.  By  letting  H{s)  =  e~’",  those  actual  delay  limi¬ 
tations  displayed  by  human  operators  during  tracking  tasks 
can  be  approximated  by  the  parameter  t,  an  effective 
transport  lag.  By  incorporating  this  approximation  and 
noting  then  that  the  transfer  function  relating  u(t)  and 
(t  t  +  T*)  is  e~^y(l  —  e~")KT*,  Fig.  1  reduces  to  Fig.  2, 
a  single-loop  pursuit  tracking  formulation.  The  open-loop 
transfer  function  Yq{s)  relating /(l  +  T*)  and  e(t  4-  7^)  is 
given  by 
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T*,t)G{s) 

KT* 


(11) 


.V.A.,  ■’KhV.l.tW  C'ONTROL 


Fig.  1 .  Block  diagram  for  the  single- point  preview  control. 


Fig.  2.  Equivalent  block  diagram  for  the  single-point  preview  control,  H(s)  =  e 


The  stability  of  this  system  is  determined  by  the  char¬ 
acteristic  roots  of  1  +  OJ"  equivalently, 

1  +  +  T*,  t)G{s)/KT  =  0.  (12) 

To  test  the  utihty  of  this  model  by  comparison  with 
experimental  findings,  open-loop  gain /phase  frequency  re¬ 
sponse  results  measured  by  Weir  et  al.  [9.  Fig.  12-C]  for  an 
automobile  straight-line  regulatory  control  task  are  pre¬ 
sented  in  Figs.  3  and  4.  These  experimental  results  repre¬ 
sent  the  open-loop  frequency  response  relating  the  driver’s 
output  (presumably  an  estimate  of  future  lateral  position) 
to  an  assumed  error,  derived  by  the  driver,  between  the 
previewed  inpuf  (straight  road  ahead)  and  the  driver’s 
output.  Since  this  may  be  categorized  as  a  form  of  linear 
pursuit  tracking,  the  formulation  of  (1 1)  is  accommodated. 
Also  shown  in  Figs.  3  and  4  is  the  frequency  response 
calculation  for  (11)  with  parameters  T’*  =  3.0  (s)  and  t  = 
0.26  (s).  The  model  output  y{t  -I-  T*)  is  the  estimated 
vehicle  lateral  position  at  time  /  +  7’*;  the  input  /(/  +  T*) 
=  0  is  the  lateral  displacement  of  the  previewed  path.  The 
automobile  {F,g)  dynamics  used  in  (11)  appear  in  Ap¬ 
pendix  I-A  and  duplicate  those  identified  in  [9].  The  values 
of  T*  and  t  were  selected  to  fit  the  experimental  data  as 
closely  as  the  single-point  model  would  permit.  As  can  be 
seen,  the  model  and  experimental  results  display  exceUent 
agreement.  Not  only  does  the  preview  model  reproduce  the 
—  6  db/ octave  slope  of  the  familiar  manual  control  “cross¬ 
over”  model  [2],  [8]  gain  characteristic,  but  also  the  peaking 
phase  characteristic  usually  displayed  in  manual  control 
task  experimental  data  of  this  kind. 

The  model  parameters  T*  and  t  appearing  in  ( 1 1 )  repre¬ 
sent  the  average  preview  time  used  by  the  driver  and 
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his/her  effective  transport  lag  associated  with  this  particu¬ 
lar  control  task.  The  values  of  T*  and  t  used  here  fall  well 
within  the  range  identified  by  other  investigators  studying 
straight-line  automobile  driving  [10]-[12]  and  human  oper¬ 
ator  tracking  performance  [2],  [4],  [9]. 

Interestingly,  for  the  relatively  simple  control  task  of 
topical  straight-line  automobile  regulation  as  discussed  here, 
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Fig.  4.  Frequency  response  phase  comparison. 

the  vehicle  dynamics  portion  of  the  total  transfer  function 
(11)  does  not  play  a  dominant  role  except  at  very  low 
frequencies.  As  a  result,  the  open-loop  transfer  function 
gain  characteristic  (11)  is  closely  approximated  by  the 
human  operator  term,  e“''y(l  —  e~")  *»  e~^‘'/rs.  Such  a 
result  would  support  the  well-known  fact  that  tracking  task 
test  results  for  simple  automobile  regulation  [8],  [9]  can 
generally  be  approximated  by  the  “cross-over”  model  form 
Ce~”/s  (C  being  the  “cross-over”  gain  constant)  in  the 
vicinity  of  the  cross-over  frequency.  Moreover,  in  such 
cases  where  the  above  approximation  docs  hold,  1/t  be¬ 
comes  C  in  the  “cross-over”  model  representation. 

For  the  simple  manual  control  pursuit  tracking  task,  as 
represented  here  by  straight-line  automobile  regulation,  the 
modified  optimal  preview  controller,  even  employed  in 
only  a  sin^e-point  form  [W(ri  —  t)  =  5(7*)],  appears  to 
accurately  mimic  human  control  behavior.  It  might,  there¬ 
fore,  seem  reasonable  to  conjecture  that  human  operator 
strategy  during  simple  pursuit  tracking  (or  at  least  straight- 
line  automobile  regulation)  is  closely  akin  to  an  optimal 
preview  error  minimization  process  which  ignores  or  is 
unaware  of  transport  delay  mechanisms  inherent  in  the 
control  processor.  A  more  stringent  test  of  this  hypothesis 
is  offered  in  the  following  section  wherein  transient  auto¬ 
mobile  path  following  is  examined  using  the  modified 
optimal  preview  control  model  in  its  complete  form. 

Application  of  the  Optimal  Preview  Control 
FOR  Simulation  of  Closed-Loop  Transient 
Automobile  Path  Following 

The  previous  section  addressed  the  applicabihty  of  the 
optimal  preview  control  to  the  problem  of  preview  regula¬ 
tion  and  the  effects  of  an  inherent  transport  delay  within 
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Fig  6.  Closed-loop  simulation/ test  result  comparison. 

the  controller.  Using  straight-line  automobile  regulation  as 
an  example,  the  single-point  preview  model  was  compared 
with  experimental  results  within  the  frequency  domain.  In 
this  section  application  to  the  tracking  problem  is  demon¬ 
strated  using  the  general  preview  control  model  (7),  with  an 
inherent  transport  time  delay  to  simulate  a  closed-loop 
automobile /driver  path  following  maneuver.  Results  from 
the  model  are  compared  with  time  history  measurements 
from  corresponding  fuU-scale  vehicle  tests. 

The  specific  closed-loop  maneuver  examined  here  re¬ 
quired  an  automobile  driver  to  perform  a  standard  3.66  m 
(12-ft)  lane-change  within  a  distance  of  30.5  m  (100  ft)  at  a 
vehicle  speed  of  approximately  26.8  m/s  (60  mi/h).  The 
initiation  and  completion  of  the  lane  change  was  con¬ 
strained  by  3.05-m  wide  (10  ft)  cone-marked  lanes  (Fig.  5). 
The  lest  vehicle  was  a  standard  American  compact  with 
measured  parameter  values  shown  in  Appendix  I-B.  A 
representative  lest  result  for  this  vehicle/driver  combina¬ 
tion  appears  in  Fig.  6,  showing  recorded-time  histories 
of  lateral  acceleration,  yaw  rate,  and  front-wheel  steer 
angle  (13]. 
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Also  shown  in  Fig.  6  are  computer  simulation  results 
using  the  optimal  preview  control  (7)  with  an  assumed 
human  operator  transport  delay  term  relating  u^{t) 
and  u(r).  The  transport  lag  term  is  included  here,  as  in  the 
previous  section,  to  approximate  the  principal  human  oper¬ 
ator  lag  effects.  The  calculation  of  (7),  steer  angle,  seen  in 
Fig.  6  is  for  values  of  t  =  0.2  (s)  and  T  =  1.3  (s)  using  ten 
equally  spaced  points  in  the  preview  interval  to  approxi¬ 
mate  the  integral.  The  values  of  T  and  r  were  selected  to 
closely  fit  the  test  measurements.  The  {F,g)  automobile 
dynamics  model  is  the  same  two-degree-of-freedom  model 
appearing  m  Appendix  I-A,  evaluated  for  the  parameter 
values  identified  in  Appendix  I-B.  The  previewed  input 
f(r\)  appearing  m  (7)  represents  the  desired  lateral  path 
deviation  and  was  obtained  during  the  simulation  using  the 
simple  straight-line  path  segments  shown  in  Fig.  5  as  input. 

As  seen  from  Fig.  6,  excellent  agreement  can  be  obtained 
between  the  experimental  results  and  simulation  predic¬ 
tions  using  the  two  numerical  parameters  (t,  7)  and  a 
simple  straight-line  path  input.  Variations  in  the  value  of  t 
primarily  influenced  the  closed-loop  system  damping;  larger 
values  producing  reduced  damping.  Variations  in  the  value 
of  T  influenced  control  (steering)  amplitude  as  well  as 
damping;  larger  values  of  T  producing  lower  control  am¬ 
plitude  and  increased  damping. 

Finally,  Fig.  7  shows  a  comparison  of  the  preview  model 
predictions  and  measured  test  results  for  a  modified  set  of 
vehicle  dynamics  (F,  g).  The  same  vehicle  was  employed 
but  with  modifications  to  its  mass  center  and  rear  tires  so 
as  to  produce  a  new  set  of  parameter  values  listed  in 
Appendix  I-C.  As  shown  in  Fig.  7  the  principal  change  in 
the  closed-loop  response  from  Fig.  6  is  an  increased  steer¬ 
ing  gain  (lower  steering  amplitude  for  the  same  nominal 
maneuver)  and  decreased  damping.  Larger  values  of  r  (0.3) 
and  7(1.55)  were  required  in  the  calculation  of  (7),  shown 
as  steer  angle  in  Fig.  7,  to  better  approximate  the  reduced 
damping  and  smaller  amphtude  steering  control.  A  com¬ 
parison  of  computed  vehicle  path  trajectories,  correspond¬ 
ing  to  the  baseline  and  modified  vehicle  responses  shown 
in  Figs.  6  and  7,  appears  in  Fig.  8. 

Characteristic  roots  for  each  of  the  closed-loop  systems, 
as  calculated  from  the  constant  matrix  (13),  are  shown  in 
Fig.  9.  The  matrix  (13)  (see  Appendix  I-D)  is  similar  to 
that  given  by  (9)  but  includes  the  influence  of  the  transport 
lag  term  approximated  by  the  first-order  Fade  poly¬ 
nomial 
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Note  that  the  reduced  damping  in  the  driver/vehicle 
responses,  displayed  in  Figs.  7  and  8,  is  equivalently  repre¬ 
sented  by  the  corresponding  closed-loop  characteristic  root 
locations  shown  in  Fig.  9. 
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Fig.  7.  Goscd-loop  simulation/test  result  comparison — modihed 
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These  results  and  those  of  the  previous  section  deiticr  ■ 
straw  useful  application  of  the  optimal  preview  m:d;:  jji 
simulation  of  closed-loop  automobile  driving.  Tlis  ]:n:r  - 
cipal  conclusion  concerning  these  results  is  th^.t  driver 
steering  control  strategy  during  path  following  can  be 
accurately  represented  as  a  time-lagged  optimal  prev  iew 
control.  Similar  applications  and  extensions  to  problem  s  i:: 
other  fields  are  clearly  suggested  by  the  results  shown  lierc. 

Conclusion 

The  optimal  preview  control  model,  applied  here  to  the 
closed-loop  automobile  path  following  problem,  clfe;]  s  a 
useful  and  direct  method  for  representing  closed-loop  be¬ 
havior  of  linear  driver /vehicle  systems.  It  is  suggested  ;hat 
driver  automobile  steering  control  strateg>’  during  patn 
following  can  be  viewed  as  a  time-lagged  optimal  prev  iew 
control  process. 

The  general  linear  system  formulation  of  the  preview 
control  methodology,  demonstrated  here,  permits  appli¬ 
cation  to  a  broad  range  of  problems  relating  to  man  - 
machine  systems. 

APPENDIX  I 

A.  Vehicle  Dynamics 
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The  calculation  of  (11)  appearing  in  Figs.  3  and  4  used 
the  following  parameter  values  identified  in  [9]  for  ve¬ 
hicle  D 


The  linear  dynamical  equations  of  an  automobile  for 
lateral  and  yaw  motions  are 

y  =  V  +  Uip  (Al ) 


t;  =[-2(C„^-b  C.J/mt/]o  -l-[2(*C„^-  aQ^)/mU  -  U]r 
+  (2C.^/m)6  (A2) 


a  =  1.41  m  (4.63  ft) 
b  =  1.41  m  (4.63  ft) 
m  —  2016  kg  (138  slug) 

I  =  4013  m-N-s^  (2960  fflbs^) 

(/  =  22.3  m/s  (73.3  ft/s) 

=  25  266  N/rad  (5  680  lb /rad) 

=  70  933  N/rad  (15  960  Ib/rad). 


r  =[2(hC.,-  aCj/IU]v+[-l(a^C,+b^Cj/w]r 


-f  (2aCa^/l)8pfy 

(A3) 

i>  =  r 

(A4) 

where 

V  inertial  lateral  displacement  of  the  vehicle  mass 
center, 

V  lateral  velocity  in  the  vehicle  body  axis  system, 
r  yaw  rate  about  the  vertical  body  axis, 

\p  vehicle  heading  angle,  and 

front  tire  steor  angle,  control  variable. 

The  parameters  appearing  in  (A1)-(A4)  are 

U  forward  vehicle  velocity, 

Q,  front  and  rear  tire  cornering  coefficients, 
a,  b  forward  and  rearward  locations  of  tires  from 
the  vehicle  mass  center,  and 
m,  I  vehicle  mass  and  rotational  inertia. 

The  above  equations  can  be  expressed  in  matrix  notation 
as 

(A5) 


The  constant  observer  vector  (1,0,0,0)  provided  the 
vehicle  lateral  position  y. 

B.  Baseline  Vehicle  Parameter  Values 

The  vehicle  parameter  values  listed  below  and  used  in 
the  calculations  appearing  in  Fig.  6  were  derived  from 
vehicle  wheelbase/wcight  measurements  and  steady-state, 
constant-steer  vehicle  test  results  [13] 

a  =  1.37  m  (4.5  ft) 
b  =  1.22  m  (4.0  ft) 
m  =  1563  kg  (107  slug) 

1  =2712m-N-s2(2  000  ft-lb-s2) 

U  =  25.9  m/s  (85  ft/s) 

=  19  438  N/rad-(4  370  Ib/rad) 

=  33  628  N/rad  (7  560  Ib/rad). 

The  weighting  function  W  appearing  in  (7)  was  selected  as 
constant  1.0  over  the  ten-point  preview  interval. 

C.  Modified  Vehicle  Parameter  Values 

The  vehicle  parameters  of  Appendix  I-B  were  altered  to 
those  values  shown  in  this  section  by  a  rearward  shift  in 
the  vehicle  mass  center  and  a  decrease  in  rear  tire  inflation 


x  =  Fx  + 
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pressures 

a  =  1.43  m  (4.7  ft) 
b  =  1.16  m  (3.8  ft) 
m  —  1753  kg  (120  slug) 

/  =  2712  m-N-s^  (2000  fflb-s^) 

U  =  25.9  m/s  (85  ft/s) 

=  20  906  N/rad  (4700  Ib/rad) 

=  29  536  N/rad  (6640  Ib/rad). 

The  closed-loop  calculation  using  these  paranaeter  values 
appears  in  Fig.  7. 


D.  Stability  of  the  Closed-Loop  Optimal  Preview-Controlled 
System  Including  a  Transport  Time  Lag 

Given  the  system 


II 

(A6) 

u  =  e 

(A7) 

u°=  —c^x 

(A8) 

where  F,  g,  and  are  defined  in  (1),  (4),  and  (9).  If  the 

transport  time  lag  e  is  approximated  by  the  first-order 

Fade  polynomial, 

(A9) 

(AT)  becomes 

li  =  — (  — «  +  M°)  —  ii°. 

T 

(AlO) 

Substitution  of 

u°—  —c^x 

and 

=  — c^[Fx  +  gu] 

into  (A  10)  produces  the  closed-loop  state  equation 


equivalent  of  (A6)-(A8).  For  small  t,  stability  of  ti 
time-lagged  optimal  preview-controlled  system  is  provide 
by  the  characteristic  roots  of  the  system  matrix  appearir 
in  (All). 
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An  Opiimal  Previ<»w  Control  for  Linear  Systems 


C.  C.  MacAdam  ^ 

A  technique  for  synthesizing  closed-loop  control  of  linear 
time-invariant  systems  during  tracking  of  previewed  inputs  is 
presented.  The  derived  control  is  directly  dependent  upon  the 
properties  of  the  controlled  system  and  is  obtained  by 
minimization  of  a  defined  previewed  output  error, 

I  Introduction 

This  paper  presents  a  general  method  of  control  synthesis 
applicable  to  linear  lime-invariant  systems  utilizing  preview 
control  strategies  for  regulation  or  tracking  tasks.  A  common 
example  of  this  type  of  dynamical  behavior  occurs  during 
normal  automobile  path  following  in  which  drivers  “look- 
ahead”  to  follow  a  desired  path.  A  frequent  source  of  preview 
control  strategies  in  various  man-machine  systems  is,  of 
course,  the  human  operator.  It  is  widely  recognized  that 
human  operators  are  capable  of  controlling  and  adapting  to  a 
wide  variety  of  dynamical  systems,  many  of  which  are 
vehicles  with  preview-oriented  control  requirements  such  as 
automobiles,  bicycles,  and  complex  aircraft  [1-7].  Although 
this  paper  does  not  offer  evidence  as  to  the  utility  of  the 
proposed  control  synthesis  for  man-machine  systems  in¬ 
volving  preview  strategies,  it  is  suggested  that  the  method 
presented  here  can  be  applied  to  such  problems.  Portions  of 
the  work  by  Tomizuka  [8],  which  treated  a  similar  problem, 
indicated  useful  application  of  optimal  preview  control 
methods  in  representing  man-machine  dynamical  behavior. 

The  particular  method  presented  in  this  paper  is  directly 
applicable  to  general  linear  system  representations  assumed  to 
incorporate  preview  control  strategies  that  depend  only  upon 
knowledge  of  the  current  values  of  the  state  and  control.  The 
optimal  control  is  derived  by  minimization  of  a  performance 
index  that  is  defined  as  a  mean  squared  preview  output  error. 
It  will  be  shown  that  the  derived  control  function  is  not  ar¬ 
bitrary  or  independent  but  depends  directly  upon  the 
dynamical  properties  of  the  controlled  system. 

II  Statement  of  the  Problem 

Given  the  linear  system 

X  =  /^-i-gM  (1) 

(2) 
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where, 

X  is  the /7  X  1  state  vector 

y  is  the  scalar  output  related  to  the  state  by  the  x  1 
constant  observer  vector  transpose 
F  is  the  constant  n  x,  n  system  matrix 

and 

g  is  the  constant  n  x  1  control  coefficient  vector 

find  the  control,  w(f),  which  minimizes  a  local  performance 
index, 

j  (3) 

over  the  current  preview  interval  (/,/+  7),  where, 

W  is  an  arbitrary  weighting  function  over  the  preview 
interval 

and /  is  the  previewed  input. 

The  performance  index  given  by  (3)  represents  the  weighted 
mean  squared  error  between  the  previewed  input  and  the 
preview^  output  as  defined  below. 

The  previewed  output,  y(v)j  is  related  to  the  present  state, 
x{f),by 

y(r})  =  m^<t>(rf,t)x{t)  +  (4) 

where, 

«(ii,/)acxp{f*(T?-r)] 

is  the  transition  matrix  of  the  system  F  [9] . 

If  u(t)  is  assumed  selected  on  the  basis  of  a  constant 
previewed  control,  u(()  «  u(t),  equation  (4)  simplifies  to 

y(7j)  =  m^0(Tj,/)x(/)  (5) 

and  the  performance  index,  (3),  can  be  written  as 

-M(r)  j  dv  (6) 

The  above  assumption  simply  requires  the  resulting  op¬ 
timization  to  reflect  a  control  strategy  dependent  only  upon 
current  values  of  the  state  and  control.  This  assumption  is,  in 
part,  motivated  by  the  pot^tial  application  to  those  man- 
machine  systems,  wherein,  it  is  assumed  the  human  operator 
is  limited  in  deriving  or  having  knowledge  a  priori  of  more 
complex  or  optimal  control  waveforms  over  the  preview 
interval. 

The  necessary  condition  for  minimization  of  J,  defined  by 


laa/Vol.  102,  SEPTEMBER  1980 


Transactions  of  the  ASME 


eauaiion  (6,\  w’v-'  ’■esoect  to  the  control  ’s  by 

dJ/du  =  0,  or 

dJ  2  rr. 


2  rr 

rl, 


m^<i)(7),Ox(/) 


-«(/)  \  m 


'  ni’’o(Tj,|)grff  j  W(r]-t)drf  =  Q 


Equating  <&(t),  $)  with  exp[F(7;  — $)]  =  I  +  ^ 


where  I  is  the  identity  matrix,  and  performing  the  in¬ 
tegrations,  (7)  becomes 

dJ  2  f'*''  c  r  ^ 


3cv,?.t'0"" 'b  ^er:^ese?.:s  a  DroDon.’ona’,  contro"er  with  gain 
inv  er:;r  .y  ieiii:tcl  lo  the  preview  inierva.,  'P .  and  operating  on 
the  vrro’:  hen/eer  tne  previewed  input.  /(/^7^),  and 
Vf:  i  "  :iiai.  porno:',  o:'  the  pKJViewed  output  deriving 
frcn  t  “(j  vttcAor's  current  initial  conditiort.  Likewise, 
equation  i v)  can  be  interpreted  as  a  proportional  controller 
opeiai;  rij2  on  a  suni.ar  error  averaged  and  weighted  over  the 
prt  vievv  :  ii;e*v5il  (r,  /  -  T)  oy  the  additional  terms  appearing 
in  equation  (9) 

Tn(;  optimal  solutior.,  i/W/) ,  can  also  c»e  expre.ssed  in  terms 
of  iny  ou  -reni  non-cptimal  uir)  and  correspondingly  nonzero 
previe^v  output  error,  fCrj,  by  writing  equation  (9)  as 


/mj)  -m''(p(7;./)x(0 


(  Tf )  — /)  C2t? -f  u  (  0  I  x T )  \ f ) J 


I  \ 


-(j7-/)in’'j^/+  yn+i)!  ]8“(0j[(t;-f)m^ 

7nri)Y  =  0 

Solving  (8)  for  w(r)  yields 

ff«  t  * 

YrYn! 

/[r'h— 


(;)  :=  »(r)  -f 


({v)A{v)^in-t)drj 


AHv)^^(n-r)dv 


t  rl  (w+1)!  J 


e(p)  A  Jlv)  -  m^<t>(Ti,r)x(0- u(t)A(v) 


/=^(n-tr 


For  the  special  case  ofW^(T7  — /)  =6(7^)»as  before,  equation 
(13)  reduces  to 

u°(t)==u(l)-h‘'i!'P  (14) 


'  ^  ^  (7* +1)1  J  ->  The  formulation  expressed  by  equation  (13)  can  be  useful  in 

.Q.  describing  systems  which  do  not  achieve,  though  closely 
'  ^  approximate,  the  optimal  system  behavior.  Such  cases  may 
arise  from  limitations  in  achieving  the  precise  optimal  control 
where  w°(r)  represents  the  optimal  solution.  For  the  special  due  to  time  lags  or  dynamic  properties  inherent  in  the  con- 
case  of  fy(rf  —  r)  as  5(P),  the  Dirac  delta  function  for  0  troller  and  not  accounted  for  apnor/ in  the  optimization. 


<  P  ^  r,  (9)  simplifies  to 


w<>(/)  = 


/(,*7')-m^[/+ X;  ^^^]x(0 


=ir(f+n->'o('+m/(7'/r) 


While  equations  (9)  and  (13)  are  equivalent  mathematically, 
the  latter  deomonstrates  an  explicit  relationship  between  the 
derived  optimal  control  and  the  previewed  output  error 
function  appearing  in  the  performance  index  of  the  original 
problem  formulation.  Simply  stated,  the  current  control  level 
is  modified  only  in  response  to  a  nonzero  function  of  the 
previewed  output  error,  and,  in  this  sense,  analogous  to  an 
integral  controller. 

Finally,  dependence  of  the  derived  optimal  control  upon  the 
system  (F,  g)  properties  is  clearly  demonstrated  by  the  explicit 
presence  of  F  and  g  in  equations  (9)  and  (13).  Furthermore, 
information  concerning  stability  of  the  closed-loop  system 
utilizing  the  optimal  preview  control  of  equation  <9)  or  (13)  is 
provided  by  the  characteristic  roots  of  the  constant  matrix 
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or 


where 


(F-gc^ 


latroduction 

(15)  The  purpose  of  the  present  paper  is  twofold.  The  first  is  to 
obtain  an  analytic  expression  for  the  critical  speed  of  a 


resulting  from  the  substitution  of  (9)  into  (1).  For  the  special 
case  of  =5  6(  P),  (15)  becomes 


(16) 


Ill  Summar> 

The  optimal  preview  control  model  presented  here  offers  a 
useful  and  direct  method  for  representing  closed-loop 
behavior  of  linear  systems  utilizing  preview*  control  strategies. 
The  derived  control  is  directly  related  to  the  properties  of  the 
linear  system  and  the  previewed  input.  Further,  the  method  is 
formulated  in  terms  of  general  linear  system  representations, 
thereby  permitting  applications  to  a  wide  variety  of  problems. 
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Asymptotic  Theory  of  Freight  Car  Hunting 


A.  M.  Whitman  ‘ 

A  simple  formula  is  derived  for  the  hunting  speed  of  a  freight 
car  from  an  8  degree  of  freedom  linear  model  using  asymp¬ 
totic  techniques.  A  comparison  is  made  between  the  ap¬ 
proximation  and  exact  {numerical)  solutions.  The  two  agree 
within  10  percent  for  parameter  values  typical  of  present 
designs. 
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multidegree  of  freedom  model  of  a  freight  car  which  is  simple 
enough  to  convey  physical  insight  into  the  hunting  problem 
while  at  the  same  time  complex  enough  to  have  validity  for 
realistic  vehicles.  The  second  is  to  illustrate  the  simplification 
which  can  be  effected  in  problems  of  this  type  by  employing 
asymptotic  methods.  These  methods  are  model  independent 
and  rely  on  tne  fact  that  the  creep  forces  dominate  the  motion. 

Previous  work  has  included  analytical  studies  of  simple 
vehicles  [1-2]  and  numerical  solutions  for  realistic  vehicles  [3- 
4].  The  present  work  can  be  viewed  as  a  generalization  and 
formal  mathematical  justification  of  the  former,  which 
although  cleverly  done  are  ad  hoc  by  nature  and  seem  to  be 
restricted  to  systems  with  few  degrees  of  freedom,  and  a 
specialization  of  the  latter,  giving  the  same  results  in  the 
region  of  validity  of  the  expansion  but  being  restriaed  by 
nature  to  specific  regions  in  parameter  space.  The  utility  of 
the  present  work  is  in  the  simple  result  which  it  yields.  From 
this  one  can  obtain  physical  insight  into  the  phenomenon  as 
well  as  easily  calculable  answers. 


Model  Description 

We  consider  a  model  of  the  lateral  dynamics  of  a  freight  car 
composed  of  a  rigid  car  body  pinned  at  either  end  to  a  truck. 
The  pin  conneaion  transmits  a  linear  damping  moment 
(constant  c  'f)  between  the  car  body  and  the  truck.  Each  truck, 
see  Fig.  1,  is  composed  of  2  wheelsets,  two  rigid  sideframes 
conneaed  by  ball  joints  to  each  wheelset,  and  a  bolster,  which 
conuins  the  car  connection  (centerplate)  at  its  midpoint,  is 
constrained  to  move  parallel  to  each  wheelset  by  means  of 
frictionless  slotted  pins  in  each  sideframe,  and  is  restrained 
from  moving  freely  in  that  direction  by  2  linear  springs 
(constant  k  each)  and  dampers  (constant  c  each)  at  each  end. 
In  the  real  system  this  restraint  is  provided  by  the  shear 
stiffness  of  the  bolster  springs,  whose  primary  function  is  to 
support  the  car  weight,  and  the  sliding  of  the  friction  wedges 
laterally.  Further,  because  the  springs  and  dampers  are 
separated  by  a  distance  d,  there  is  a  moment  tending  to  square 
the  truck  due  to  both  the  springs  (constant  4kcP)  and  the 
dampers  constant  4c<P).  In  addition,  the  bolster  has  mounted 
symmetrically  with  respect  to  the  centerplate,  constant 
contaa  sidebearings  (constant  icg  each)  whose  function  is  to 
provide  a  torsional  spring  restraint  for  the  bolster  relative  to 
the  car  body  (constant  2^^m^).  Aaually  the  sidebearings  also 
transmit  a  damping  moment  between  the  bolster  and  the  car 
body  (constant  2c5H^);  however,  this  has  the  same  form  as 
the  centerplate  moment  and  can  be  combined  with  it.  There 
are  eight  degrees  of  freedom  in  this  model  and  we  will  take  as 
our  independent  coordinates  y,  0^,  u^,  x^,  0^,  u^. 

Here  the  superscripts  represent  the  front  and  rear  truck 
coordinates,  x  is  the  axial  displacement  of  the  truck  centroid 
relative  to  the  track  center  line,  yp  the  yaw  angle  of  each 
wheelset  of  the  truck  as  a  result  of  the  kinematic  constraint,  0 
the  trail  angle  of  the  truck,  and  u  the  bolster  displacement 
relative  to  the  truck  centroid.  The  equations  of  motion,  which 
have  been  derived  elsewhere  [5]  and  which  are  quite  similar  to 
others  which  have  been  discussed  in  the  literature  [4],  are 
written  here  in  dimensionless  form  in  terms  of  sum  and 
difference  coordinates, 
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LATERAL  STABIUrTY  OF  A  CONTROLLED  ARTICULATED  VEHICLE  - 
AN  APPUCATION  OF  BIFURCATION  THEORY  IN  VEHICUE  DYNAMICS 
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MANY  ACCIDENTS  OF  TRUCK-TRAILER  COMBINATIONS 
are  cauaed  by  loaa  of  control  of  the  vehicle. 
Therefore  inveatigationa  of  the  dyneixoic  lateral 
atability  of  auch  articulated  vehiclea  are 
ijTtportant.  In  the  paat,  moat  of  the  engineering 
analyaea  of  atability  problems  have  only 
utilized  linear  atability  theory.  However, 
linear  atability  theory  can  be  overly  generous 
i  in  identifyin^r  regions  of  stability  for  dynamic 
systems  containing  nonlinearitiea,  such  as  the 
articulated  vehicle  dynamics  problem  being 
considered  here.  In  brief,  the  physical  phenom¬ 
enon  of  interest  in  this  paper  ia  one  in  which 
the  lateral  stability  threshold  of  the  artic¬ 
ulated  vehicle  is  reduced  and  caused  to  occur 
at  speeds  below  that  ordinarily  predicted  by  a 
purely  linear  analysis.  For  exanple,  if  artic¬ 
ulated  vehicles  are  driven  under  high  forward 
speeds,  a  finite  disturbing  effect  of  a  steady 
state  straight-line  motion  can  result  in  a 
starting  of  oscillations  with  catastrophically 
increasing  amplitudes.  The  experimental  results 
in  Fig.  2  (I)  show  an  exan^le  (c)  of  unstable 
vehicle  behavior,  caused  from  a  finite  steering 
disturbance,  for  a  speed  V  much  lower  then  the 
critical  speed  Vq  .  Thus,  the  need  for  a 
nonlinear  analysis  is  clearly  evident  here. 
Recent  application  of  nonlinear  stability 
theory  [1,2]  to  vehicle  engineering  problems  ia 
provided  in  references  [4,5,7]. 


Fig.l:  Mechanical  model  with  three  degrees  of  iSneedom  y.  y,  and  ^ 


This  paper  applies  a  nonlinear  stability 
investigation  to  a  truck,  which  is  towing  a 
single-axle  utility  trailer  via  its  rear'  pintle 
hook  on  a  flat  horizontal  road.  The  geometry  of 
this  articulated  vehicle  is  shown  in  Fig.  1.  He 
consider  a  symmetric  vehicle.  The  location  of 
the  vehicle  is  described  by  the  variables  y,  y, 
and  The  constant  forward  speed,  V,  and  the 
loading  condition  of  the  trailer,  measured  by 
d,  are  the  main  parameters  of  the  system.  The 
lateral  tire  forces  Si,  which  are  of  particular 
importance  for  the  stability  analyses,  are 
calculated  applying  an  adhesion/sliding 
approach  in  the  contact  area  between  tire  and 
road  [7J  .  In  order  to  perform  an  investigation 
of  a  vehicle-driver  system  (closed-loop  system) 
a  linear,  preview-based  driver  model  [6]  is 
employed  in  the  controlled-vehicle  analyses. 


In  Fig.  2  (I)  experimental  results  from 

three  almost  identical  field  tests  are  shown, 
differing  only  in  the  air^litude  of  the  initial 
steering  disturbance.  Corresponding  results 
from  simulations  of  these  transient  vehicle 
responses  are  also  drawn  in  Fig.  2  (II)  for 
comparision.  The  simulations  were  done  using 
the  nonlinear  Yaw/Roll  Program  [3] .  Shown  is 
the  articulation  angle,  between  truck  and 
trailer .  Following  a  short  steering  distur¬ 
bance,  the  vehicle  should  follow  a  straight- 
line  path  <y  “  0) . 


But  this  is  only  possible  for  a  sufficiently 
small  disturbance .  If  the  magnitude  of  the 
disturbance  becomes  too  large,  the  anplitudes 
of  the  oscillations  following  the  disturbance 
increase,  and  the  vehicle  behavior  becomes 
unstable  (in  contrast  to  stability  predicted  by 
a  purely  linear  analysis) .  Determination  of  the 
magnitude  of  disturbance  needed  to  produce  an 
unstable  system  response  -  for  different 
forward  speeds  -  can  be  performed  using  a 
nonlinear  stability  analysis. 
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FigJb  Comparison  of  measonnent  (I)  and  computer  simulation  (li) 
ot  transient  vehicle  remnses  of  an  equally  loaded  tnick-trkler 
combination  (d  *  -  0.436ni)  for  a  driving  ^jeed  (V«17.9  m/s)  much 
lower  then  the  critical  speed  (Vc«22xn/s). 


Applying  NeirCon 's  law,  we  can  write  the  non¬ 
linear  equations  of  motion 

ir{x)  X  -  f(x,5)  ,  _  (1) 

where  x*  -  )  is  the  state  vector,  5 

is  the  steering  angle,  and  H(x)  is  a  (non¬ 
linear)  6x6  matrix.  The  straight -line  motion 
is  given  by  oo  *  0  and  xp  ■  0.  It  is  obvious  that 
the  straight-line  motion  is  an  equilibrium 
position  of  system  (1)  .  After  inverting  the 
matrix  W(x} ,  which  can  be  done  by  power  series 
expansion  with  respect  to  this  equilibrium 
position,  we  obtain 

x-rx+g8  +  n(x,8)  ,  (2) 


where  a(x,8)  contains  the  nonlinear  terms . 

Due  to  the  steering  of  the  driver,  any 
deviation  from  the  straight-line  motion  of  the 
truck  leads  to  a  steering  response  5.  The 
position  of  the  driver  from  the  truck  c.g.  is 
located  by  the  parameter  e .  The  driver  is 
modelled  mathematically  by  an  optimal  preview 
control  approach  [6] ,  which  uses  the  linear 
part  of  ec^.  (2).  The  optimal  control,  $opt(t), 
minimizes  the  error  between  the  desired 
straight-line  motion  and  the  predicted  vehicle 
position,  T  seconds  ahead  in  time.  The 
predicted  lateral  position  of  the  driver, 
yd(t+T),  T  seconds  ahead,  is  derived  from  the 
observer  vector  mT  «  (1, 0,e, 0, 0, 0) ,  the  state 
vector*s  current  initial  condition,  x(t),  and 
the  state  transition  matrix. 


y^  (t+T)  -  m 
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If  the  dxiver  deXa^^  tis  modelled  with  a  Pad6 
polynomial,  the  steering  input  6  applied  by  the 
driver  can  be  approximated  by  (s  is  the  Laplace 
variable) 


(4) 


This  linear  driver  model  has  been  shown  to  be 
an  effective  means  for  representing  actual 
human  behavior  during  driving  tas)cs .  A  time 
delay  value  X  of  approximately  0.25  seconds  is 
ordinarily  used  in  this  model  to  represent 
"average"  driver  behavior.  Equ.  (2)  together 
with  equ.  (4)  produces  the  closed-loop 
equations  of  motion: 


L  ^  " 

where  . 
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With  we  can  write  equ.  (5)  in 

the  form 

y  -  A(X>  y  +  m(y,X)  ,  (7) 

where  we  have  now  also  introduced  the  para¬ 
meter  vector  ■  (V^d) .  The  stability  of  the 
equilibri^Jm  position  yp  ■  0  is  guaranteed  by  a 
theorem  of  Liapunov,  if  all  eigenvalues  of  the 
matrix  A(X)  have  negative  real  parts.  To  find 
the  critical  forward  speed,  we  calculate 

for  a  fixed  loading  condition,  d,  and  a 
quasistatic  increasing  speed,  V,  the  eigen¬ 
values  of  the  matrix  X(X)  .  The  stability 
boundary  is  reached,  if  one  or  more  eigenvalues 
cross  the  imaginary  axis. 


Fig.3:  Stability  boundary  in  the  parameter  space  for  the  open-loop 
system  (—  •  — )  and  the  closed-loop  system  C— )-  See  also  Fig.  5. 

Fig.  3  shows'  the  stability  boundaries  for  the 
open-loop  and  the  closed-loop  system.  For  the 
vehicle  with  a  Fixed  steering  wheel  (o  «  0), 

y^  -  (v,CD,<^,4i)  r  • 

a  rearward  located  load  can  lead  to  an  oscil¬ 
latory  type  of  instability,  due  to  a  purely 
imaginary  pair  of  eigenvalues.  The  reason  is  a 
bifurcation  of  a  Xiniit  cycle,  which  is  called 
ifopF  bifurcation.  On  the  other  side,  positive 
values  of  d  can  lead  to  a  divergent  type  of 
instability,  caused  by  a  simple  zero  eigen¬ 
value.  Fig. 4  shows  a  time  history  of  the  arti¬ 
culation  angle,'  <^,  for  a  divergent  unstable 
behavior  of  the  vehicle  after  a  steering 
disturbance . 

For  the  controlled  vehicle,  a  Bopf  bifur¬ 
cation  (oscillatory  type)  is  the  only  manner  in 
which  loss  of  stability  of  the  straight-line 
motion  can  occur.  The  influence  of  the  driver 
time  lag,  x,  upon  critical  speed  is  seen  to  be 
almost  insignificant  for  the  left  branch  of  the 
stability  chart  (Fig.  3),  indicating  that  the 
driver  has  little  control  over  the  oscillator 
trailer  motion,  which  dominates  during  this 
mode .  However,  on  the  right  branch,  the  driver 
time  lag  is  seen  to  play  a  very  in^ortant  role 
in  determining  the  critical  speed. 
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Fig.  4:  Divergent  time  history  of  the  articulation  angle  for  the 
vehicle  with  a  fixed  steering  wheel  (d  «  positive)  •  (l)  measurement 
(II)  computer  simulation. 

For  one  to  investigate  the  nonlinear  be¬ 
havior,  a  change  in  coordinates  y  t  by  y«Tx 
is  necessary  as  a  first  step  in  order  to  trans¬ 
form  the  matrix  A(X)  into  diagonal  form.  The 
matrix  T  is  given  by  the  eigenvectors  of  the 
matrix  X(X) .  Center  manifold  theory  [1]  allows 
us  to  reduce  the  system  (7)  to  bifurcation 
equations  [7]  .  (For  the  controlled  vehicle  a 
Hopf  bifurcation  always  appears  and  leads  to  a 
two-dimensional  bifurcation  system. )  In  the 
case  of  a  Bopf  bifurcation,  by  introducing 
polar  coordinates  and  applying  the  averaging 
principle  [2],  the  two-dimensional  bifurcation 
system  can  be  transformed  into  the  normal  form 

r  -  Vj  r  +  Kj  +  0(|tf)  .  (8) 

Equ.  (8)  is  an  equation  for  the  amplitude  r  of 
a  limit  cycle  (r  ~  0)  .  The  mathematical  para¬ 
meter  Vi  is  proportional  to  the  physical 
parameter  Xi  •  (V-Vq) ,  and  K3  is  a  constant  for 
a  given  loaded  vehicle.  Fig.  5  shows  azi^litudes 
of  the  bifurcating  unstable  limit  cycle  for 
different  loading  conditions  (1,2,3#  and  4), 
following  from  equ.  (8)  .  The  limit  cycles 
border  the  attraction  domains  of  the  stable 
straight-line  motion.  As  soon  as  a  disturbance 
causes  a  crossing  of  the  unstable  limit  cycle, 
an  unstaible  vehicle  response  occurs .  The  limit 
cycles  of  Fig. 5  result  from  an  investigation  of 
the  system  near  the  critical  equilibrium  point 
(Vq) .  Interestingly,  the  theoretical  result  of 
Fig. 5  (limit  cycle  3),  when  extrapolated  to 
even  lower  forward  speeds,  shows  good  agree¬ 
ment  with  the  corresponding  measurements  of  the 
transient  vehicle  responses  seen  in  Fig. 2. 


Fig.5;  Amplitudes  of  unstable  limit  cycle  solutions.  The  numbers 
conespona  to  Fig.  3.  (  . .  stable,  —  — -  —  unstable  ) 
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